


f 


j! S nN 
iby 4 ‘ ts Me , 









Institutional Archive of the Naval Postgraduate School 


Calhoun: The NPS Institutional Archive 
DSpace Repository 


Theses and Dissertations 1. Thesis and Dissertation Collection, all items 


1989 


Aircraft maneuver detection using an 
adaptive Kalman filter. 


Meng, Hsing Han. 


Monterey, California. Naval Postgraduate School 


http://ndl.handle.net/10945/25659 


Downloaded from NPS Archive: Calhoun 


| Calhoun is the Naval Postgraduate School's public access digital repository for 
F (8 D U DLEY research materials and institutional publications created by the NPS community. 
«ist | | Calhoun is named for Professor of Mathematics Guy K. Calhoun, NPS'‘s first 


lil \ KNOX appointed -— and published -—- scholarly author. 


http://www.nps.edu/library 






LIBRARY Dudley Knox Library / Naval Postgraduate School 
411 Dyer Road / 1 University Circle 
Monterey, California USA 93943 































































x ae : 


ih, ‘ a es 4 rT Ay ie 1 





Oar aad {Greg Sid D 
F sical ed fata 
fee FROR SG tas < ase | ry Sa | cari tab 
SMe gee fat a 

* ML eae abst hye et ath at “qe Spee a * 

ry 8h ee } ads gtehinte 

oy + ia! ater, et, oy TeLy, tans oe au bron on 

: he ae " aS ‘infath ENR NA ; a aS ra = Jose 

. ry why 
Sr i cr UA fe. OQ Fb is H ts afi vf ‘iy bet tate? A oath > H ae Haas ete Res pay ett 
SK i Fy Aaa Oy ea 1. asta oie at a hath yee naisrath ree Aes ‘a mea re visermtetse 
aera ¥ i) . he La,w Ate 2/8 “bi8 ‘ 
‘ ‘us ey ae are fe care arat Avg “a Mase ahha: : retbten’ ‘ 
Che a Js a Ariel ala. Ey ‘ ray r%, ime vt yn pists y, ait hs CRA ay yl sh te 3 ae od vk 
(om « ‘ 5, } Wo vate ats? ; a iaiade hs S a’ y ACA i; +3 3 ae teen ay rs i iS, WN At 
‘i * <9 "4 2 a Th sant TERY wigs, at se ane iaetaae ay Wid “id 
; 34 5 ‘s ‘ iy A s ak th ‘ { 4 hp 
owe 58 Hts 8s > ee 4 483 3 weit ois ea Ay PH AL bides a tadet pve ints APs abt Ay “ied Fhe's cat rs 
, the é * -, ; 
x $ he Hey 4 aL ; 
Le 


of waar tH MAYS Oke sii 
4a 
OY 


tN 


Su asaeses. Uf ‘ofa 


te : ‘ + ? ed \ Cees 
Se AT i aie ae — a 3 
es Ss eee * aia Pivede “ator be4 Agee 
($70) 1] “ar a : tok eh athtue x se 

























































































































































































































































































































































i a * 
He sa, hy bias 
ws ie - eee ati ceae m2 
bib te ry arms he ats 
"3 4A ah ey 4 n ‘nr ie 7 9 te ately Aste, v aaa) ieee mat ay a i ie hs oe “hve aie et ves ‘s aS att th Sys “iets fem ina bree hetaks maeas Z 
"* ohn ‘, My My ,, wa re Ser ad STE uta Ate aie: os ‘tye ines sonst py ale am 7 3 ‘ ae Y cH : 
’ yee $iafa- , . *, 
u we teat y +" sy “4 Sk a rh iS Mt i gas na 3 to pa nbecite aC * ol Peet ms aa ne Xp Hees aor 4 is iy ar Aco es = fuarl a4 pele 
2 egal ga & ‘i ave ye y eben sy hie aes Lara bra! nay ve. f ‘ 
ie Oly rey ed ier ee A ye AE weaXd tee ath A ana Marin aby? if Uae id oe BY et eta eecain aa, 4 pee y 
Hess Ee%m comraty Soha ft: a" a8: ATE St aie yk (he) ¥f ait ats "4 Vay caPasaeis aed ws gett ya Be a ak se fA, on Il oy? re 
Wetaie Sedst os a Te Pe te re Rw a ALES ICH tc) bg : pad ‘is CWE, ! 4 
F Ae ae 3 sata? , ye sta ae $f nie At) i ihe ‘nn } meet A} ayy my ey We wa cere wide Os an :"s as 
Peer tay Capel CADRE TUR ey aagenna iy TOC NORER ANA) i: te Sa ava oo Seach pl id 
AN) ay , HM ey fas aay set He sig Hh ha ala Nit sn ei she , i wae sy tea ratage! AD a eek i ‘ ot ke = 
. P| * oh ‘ ' ‘io 
TWD NRDD ana ENG neal Me UE ee enasra nea, CAs RO ea 
= : 1s LPN 
Mea BSN Wich tet ity) VS ae $;° ay } $ qe , AR "shar! lady fa fn Cees % rv " ey BS it 
aaa A, See SOI TeaTE Thal Tr us tea tty ah te re a ne atte. 
y te i Pe rae le thon. haley Fada tee aca Sbighhe aan tee we 4 Watch epare tatty et vy ety od: 
Sh I boy dees at alareyaas vs a MR 8" te HeLa He ey Sa tne "has Me iat erik ma ; 
u'n4an’ nl age hey. én? : na 3 a ai oh aP RED ale dratal rb got fiu te ola ry: he a ys wihid BAY msisi ioe font pa Ath . 
7yrh LDC Ons eae ato Saaehts tah aN Stn A AEh Ndi tye wy a intaglt 
{is oe Patterdale SR Th Pee pate tke ee eh vhs al es Danie mt apie hae a ishan 
: a tad ate! sortie a Baa SENS ta Y YAT yetac8 tae Hore 4) bry 8 t ipek cae 
RES Coe TON Wissel indy oi is TERNS Ne NNN ‘i Bie ete 
tty ESRZ , ee 2 5 te itahty dl a a Fh ero | e re pati ist " rings’ wa & Med Me 5 
4 } pei 4 « ae ee as de 
Wataru be i. Hehe WAH ! aie § eed clas sci Ge rer} n't a4 sci ri ie fait ea 
’ "* vA? gta . sig aay ‘4 hey ye d 4,4. Ay 4 ties gt Kye tet , sities ; ae ’ mai i i) ies ri apy Aus 
tals! , yf ti Lath, Pa gales a dis SO, itech ye ed AN pirie Aan ashing ‘ y wa ee ee e ‘ . ee 
pee , ee Aas BOM? 9 saci , 5M ; : 
: oF Ve Pan ats: 4 ii t vats Ay iin hae fy seen NEM TS nt ad ag aioe ‘ is Oe yy Rs tk Uhcatesk deny aes aN a eases tee ert us aa 
(RE: : : ee AN ta laty attire haf TNS eae a A Bey MAN Se Page obi (Se rareene rahi euieaaid meth 
To ylgts ” i cS ay AKG A) Sean . MARSH ann para ake As Rs 4y} ie oft eta hast iis thy BY stay” Are raat Mewes eget anes Rye “a = 
OO ae 1 a4 “ad aa visi syed ait LECT APEYE EE NCTR CC TN ETO Sere i M4 Taras std HN ake ‘ At i a is 4 
SS ict ct ee she 2 Barc abn ah genet gn aac aI HERP er UI WARE ORAS Ai ae é ae cage ce pian eves bo 
* eM, aty % 9 Vs. » 2 ‘3s ’ Hy f ASU esata? eter pf be ‘ He M , Oath 
‘ Cin : Je ox +a TNA Fits ca fi Ais ty we ae - rC ing ; 5 Me qe } sfsies 
Gane ' 4 at hijo BAS ATNZ 8h, A9f. is i ata Mi % eye ‘i ase 5 neat i Anta shaq” hs 3, sat Nata wad % t eeu ara. eat FUR hS ts sett war bi had 
m ) 1 " oh Wt gy Tite a TAS Mex 5 rr te , 1% AA m4) ef ie Mes linen ta ; et ‘a 2468 iy Hky 5 ; y. vias Ain “ re any ir f agagats a feat dah cas 
: . Seed aR AN RATA SRM Ra hms ea, TTS AMR RAR ne if ; MM ee hs ee ese wi 
' of ae at areal, ra M4 *a"s a2 fe Me b S fest he BM a Ms Pel hy tees ve ary tee at} cyl conte nyt: $0 iy ths nyt +i rs Maa sh oe estos 4 3 wire “et ac] te fatty 
Bey i f Foyle 410 at aoe bate 1% aR aa gs ite mat athe cat sd agi ps aS RN * Pen on satay Picks ES SONY ua aye ain ie ee he ax peta 
‘ A> $ aie ‘1 \ ; i 4 sit ‘aces we AS : ee Ww? J Ate ca nae 
reed tn ey" : MEY it jh +3, at " tA Rte «, dee Tie: ity se Re ants Mj % A Neh oa “a Sat aa a *, Uueans cana mia ihre ks Ha ee Ha sh Ea 
: macy hy pao! ay or * .! “a ney 
*. ' ' : bab te ; sabi pint at a a are as Me A es bi Pati Ming ca iN Ly nauKS RiRaRts es said ee tae ie rae ee om ; % ns, 
a, 2 .s v's thoes See Sarr Corey a ¢) ure. ft vy fa | * ae 4 CCRT TON Vac ot foty ’ i } Ars beacnea! blah. y ti F 
; oc) une Be ep 14 } ai 1 Fy dys * : + Pek ats Tabs ‘on ane) ae 3 oY t Mie Nae ae Baty ; 5 FEN ral VAN aigda’a arog etre y ¢ This Gian aN Te ch oe ‘erate /| trace ¢ size susieg’ 
WE tee gtk? tauren a MI ati’ «ye j stn tA'Ses 9% 1, 0 p Hy a ys Wee esha qe Wadi ne! ER i gfAl a: Wa bcoeh ehatheh hte RY fant Ear rs saat Regie oer u aa 
‘ 5° te an ' as > pae? 5 Ev etetiary ie at ara *¢ 4 a bs aeft % ‘4 Cegbe Seaton! Wad arate, a hs a if som i 
4, ‘18 Pi te? Cate o Neha gt een Lary Age hy 27 Ac ) bee Thidtdvarae, ree Viv gelearse yi rr seam icdee 
— i Nts Aas Ble A sy at a A ‘th phe ae i an ee pining : BUY were iNeaatt : ais Perit ate 
: 8 te ttl reat Tae Pras Srrat an mink gyre OK $4 aed ae wala aac a Re a fe hh cin: 
L mee : : mee Uney ta a Ne aed? aoa Mh? OA + i A 
he + f ECAR iat oO, has pai i 5 vead pee i <i ah ¥fax be Uh, if My 3 4 e Soa ie Re ue 
. ‘ ta Pete at fi dt, rh Oar hPakutaiyhly a ‘ a ine Att Jay 54 
aie ; Sia tat Pod aay eH aoe al < r alata, weet i) He Daeg ph Syacee . ive ore 
ary h 4 
7 . SLT ee, idhte Heorarhy e247 Sine. IL | i: MIS SINS wi? eNA: ait sts ay Me ACY ge Ses ale 
| ; . PSR Te el EN AB eee Mara ae HO Rui 
. . ae e me fated Bases ay ffs wee . 4 “ BEBE Vga eee ra mths 
. 7 ‘ 4° nie rt ‘ FEW ONS S cata rheaed bent ads Pashia: seg RAfawhaalge than ehea Za Fh le 2A Agea i) 
“3 3 oF 174 & ake A t rw ah \Asat eh eet An Rees 47500, Hatter events ence pid fat 23 tae. feiss Pane Pa wanes 
: “4 Bay) Uc tien fe Meth ia haan : SQA Vie + sagt ms Ay byte SSRIS, Sof ath Poe ee ths, 
; , a 7 Sty tye AM PUR PEL gle 9 Ay OE BINS toh ao gt ts gh oe Peat ul Woleshy AO Pith a Se ae Me BON Pas ee (isthe 
t ‘ rae ene ai a Se ge ye ie chon g Bee joaPe Mme YaS28 a0 20 | fs , Bi he Alb yadat A RI ry “hay 7 cb reese mapas tee ais oy \ 
¥ : + hem y sae vt dy ea io ete 6 el A Bg Pee ie phe Galt ware ry: ena Rict nyt x it te fy ry by: ( ers aS pr es ae Bane 
‘ ‘ RATE he Ar aaa Py SN Gl 2%, OG oat azat yuh 28 bos Be ie. sabe Patan geese Midi UCL id fated iy eek ze ott rite h Eh 5M, ine ia 
, § i ey Rave %y ede hd, SUAS ARVEE : rie SiH AoL Sak aa ft Ly fash aT Seater Peon eae : 
"t aa Sete ce atte +” cu wth) BNE Fi on aby! Bae, ye Taey: Go bie? ere) piste fe Neat 3 Ww on er ras oe lene pits e 
2 tee eek be A AG) te Ashfall eae Se yeage ee “3 Ke Pas bate Set HEE a ¥ “fos Fi! BH Ay Se Reidy 
sab Ba ga aA Te oe RE INE le Seki reer HEN Sees en rt Sh Se tae na i 
PEear we Aver Wey mies, > re st a Ae VET Se POEs OTL EEL TL Loe ee *” Ht Di pi Heat NE ier a b Lig 
Cea ay go Bare Bre Reatiiy Maar haf PASS lage atts Oe PhS ct ; , in pisaahe ‘ 
%, “> ; “4 4 $ 2 ie et ye it ‘ f mace aes if cud a i te put cuir: ee ih i fs seas ag 
4 4 { Vu ot A 2 ~~ nes uy pra aro bi an at ty fs . K 
‘ ° tal Ge ery é tk my og ® 8 Ore va wins Wye orn 
- ” D W35 {eye Ry ie hey Ht 2S Heres yr bb it Risk ages wal “gh eee Nay ARAR A !50 Ags sal 
5) “green ie? : wis SEN aS Renae vats os vat hy ne ba ey: Ste Ss ee Potent ae yy ; ’ he 
rr SR ONAtL TOMER peony ras eee UN SR Nt aay a i ue ta25 - 
oy tae Mee d fate at ey 2 lato ifn Pee i EP hie f sje ivy fa! re od 
repre tne Va Xt AT Viet tis of ifs peas peta ae ae A hat ath erage wet, ontan of Uae ir? as are 
if a WPS R ES byte ium Wa yey te oe Wer yarire | SENG Ce aoe ars ‘ ra hes 
y: hy ’ eA bag yi heal Hg 2 ae OY? ae ce ata Ath ye anate neae wird ; ones eg At eS bore tHe 
res eget ye ete ERP RR OM RELL Stra th mintaceiainedy fe ces ice hes 
So. ebtcetet | Soa, er wene A eAti This ate tera? acy ’ eAg es yeas a fain? 
#y LRG HA Fe sede gly dy Saath AastiPey - ‘sy aN cs Ps vodeie < itdes coh ex ee 
3 ‘5 XY. i, WAN Vaeg Ritry § soe tires ee ee + gs 4 ye" ta ar \ 
Rae | Cie mag By) A te Nek el! a >7 Me ; 
Be a Rh ts ah ane e5s s “4 hp m a oe a4 siekee 


a “Fy CONSE ti twarient 


eke #670 me Feheneee pets . 


$ 
=o Se 
Ls neh tet eR i's PERE 5) 
ot Seriacts PS ON TaA TERS LF, 
Be a 2) sac ad eae beet reat hen? 
PH HA Loy f ‘fy ey 2 ‘i ACHAT 4] ese hel ot AP ie 2 
REL eres ter} ye POR, 24 ‘i ae iy fia poh ice ts 4 roy ee ‘ 
PAS ats tt At, eit en 7 CRA, aah 4 
Sos ‘zi oe ypecie! thy rial siege nit eG #e Pe 
Fyne gels aj oud Mech vam SySteay pediaen 


a as Fb hated Pear ite 
geld fs Rt, Seloed 










i? 7a FONG. UP Ta ahem 
A ret s ose “a2 
a Va “ie are 





‘ 
e 

iar! 7, Yt 424 
Pa Bum ats vient 
9 i] 

{ 





F.9 
“RT OE i fa Fad Vy 
Pore coe FAT Fa aT atari ata 
ray 8 Ww uf test DATO pee Ot Badouee as 
: a 3 4 “ay 

Hie ANE tte et at Sy, 


RNAS SA ETRE BAT Ba ery 
3, ot Wh. rae hg, Avante JAS iszatt FN 
, 








084 ra rm fe, — Wave 




















































































































































































































































i : hou tries ee om 
Wye are Ping “ a A Age fad ty aiate vite DIRLE at ces tier wt treed Son ae Soe 
; o4 Ul Pum ae hose, ¢ A LD, ¢ ONT AS ra aT he ae ee by ei way: x rete Rey 
Ae a ans ti Nec setts SL NAOT ENE Ite Emote nara Lean aeta So eta re * 
ar ts SF ae a" ae 2% <> these, rea i) At ? 2 east iat 7 Cail pide Sok othe By a5} Mi tafs’ 2) Wy cht Ly as, ee a 
4 THe? F yf SY FAY I yA aH Ais i -¢¢ fe. Tye on ihe asi aig A hace A ray, he Lyiet rf Pole wivie hat 
TT. ler nee éy0 Sveviize “a yey Wg py hace Aa ais me Bat sear ares rhe Beer a < ee ue 
1% 4) A a fae en WIE AAs Zep leneau give tens Batts . A rene tit Tet eke 
ey Rak, ey ay Hse ty ‘i a seh at sane Siete ee st ea Ri sisi: Tite ruzidiva inde J cacehuee: eae 
red aks ped eo the . Tat, ISO OP ab eae Path Fy aid : per 4 Net pelea aie Aide dic po Tae et iS Re 8 
‘ ‘ ¢ wet x er ree por SH ‘ fie ole 
ATn8, 4 A ail Ry ua a) an Tie Foret’! 4° eat ad; canes ae ze 
. 46m ne. val A ~ ‘ ard fh ya: dy . co ite fone ve.2, bid a 7 ae ete: A Be 
4 % . a $o IR bebe ree un ee een Bile PAPE ake PY Y H : mea ast 7% aces: 5 a sete Ket a coche 4 Sealy Se tnd j ae 
? f no4s 170% Vrs aye 4 EVRY A a et eG ° Bee any Sh « pa, PF ipta= D eine okies ‘F Lone Pear A, feeath fee rae Rs sty Ra Res ae sate Naat noe sz 
7 , ' yi eR on A. RHE I TONE. | af rah aera oa fete a he en 3 hy dig gland Wrest be 4 . (sd Ae Arete, wet P> yi vy, 
; , ’ fioyl LIS Sree Mea cies ee SiGe eo « A MSN the Bing Twi y ie ty Dene 3 eine dts aeeit oe ep, set sieee Hoe 
ace the, Ps ak uM Ye a Pua PEW Nasa, Bun ae eager eu mh ALN YA ; aah Be ne ere Tes ee Wes te ae aera hire 
: 4 J fy ‘ He eats gee oth aeeER: : Bee yt Pit aytl oanttg rhs ee Kier ae y: 
pices 7 eats Cay guy, se ; sa £5 Oe reat be Set A alot S as 1 on aS ie 
5 ' af : 5 = SFR 20h? WR TE heset Se a Pa Oat rf AT mt eta ‘yye 
. Coe Ode mine URS RTE eye BE Wes Pees ri AA 
s) 4 ’ ‘ + tts aces *s patie ei Mae Fk Fae ¥ rene rf oot Hh ae 
= Fr + tpi ay pe hares O if 2% i wyet £3 a ee 1a ead TyaGt ae i 1509 aa ae 
3 w 4 be ota ; is! Lees bis Ed Nahe: Sis cee pated 
? ps wifes oe ot ii Mire r Renee eye ere SRE bit el rey. 
‘ ee a x AEN, +A <3 My 4 oe rt : ire 
a en a (i SAO SUSUR 1 titi tcaeti oe a said eee a rca 
ad r * ae apg.) é rth) r oe! hss 2, aeat oh ’ wea = ‘ ~ 
it ray, A yng meieea ded Sy OUP Heenan ge eisaag Ure are fe fe platy 
a) ha BF Lee, mgt pete Be. Se 
‘ 3, , : id My Se BERLE SG ASS PWS Fey ery 
4 : . ! ale £ eke bbe ; ies fue pi riye be 
r : AB alg v p> a2 they) lege se + an ght eines ps ADY Se ie Sh fet Panty aaa Baste ‘- 
; > yey was? id ots Ut Ae he srk DENTONeCS, aie. santa Ms vi Upon Ihe os iy ie 
ae cyituen sig) a eae aera Oe eae ae ae Bee noes eieinahes see emaiten, 
aa | 2 LPSTRY SH i axe AG RENE! nla det pe le 4 paste yk ages ioe a 
PAU asta PROPIA: i N we Fait CAEP Ont Mareen . 
Pa ant . tiie anh detivdictae arise neg ue ee nar ort At es cena Ah 
ae ‘ a4 tH er aaht ve af Teesar ay) At iu a Pid Bact va eg ites ms = ak nanioet Fist 
, ap ghee Rsv is r Sf FT Ay sive; PR iF He aie rig? eee IR “F2yV.T AI aot 4 £4 oe oY Pawantens eh ge sy pi ‘iges ie eae 
aeaels 3 aesldy at Tien tao ey cova ied a ERLE ALS. cries Radi ansire eatce Eilat heonen . 
a sen iee ve : rine ay 
si me» aK 5 Tyee ks ap ne ty Bet Seater 2p rt atest wpe “Fhe 4 pines laine ours 
: + 2 i ts ArT aka thee ta neg ap Seshadri ge Sith isch tea bs CA Rod ete wore ee Oi se ene 
He te Fi; Ray Pweg Uf ss ah Psinv eRe We wees th tie Sues ay Veter ries sees pikes 
VOERT OPE TES YE ae. BG me Se Farreded uae ee aerate daha i eRe ag va or waiweyy 
4 Tatas ka ieee To Saat Rorec oa 
a gt a) Vode STO MEE patter, Bcg t any © oe Sores 4.f se 3 ia 
Ae Pet aes Rigs. sha erin Sea hee sansa Shea See: sane pS te oh a0 
4 M nH Poe he a + ike pees evar int Sa ponies i) + ea res PRET See Ggerr? 
Res ; wee 3 AE Ad ays DORA PF “i>, b Si : ass dy esate 
t . a é Pe A rtp OE oe? SOE tg ca ry F Co “ ‘ aly oe i thy 3S 4 - Tet hy ee tees one ae eee Pom bi a eee sacetptend pears 
Fi als ° F a es is te f x fa Meets Eton 33, At; Bice poe BE ae maser. leet rate at ae pos ta jae reece eae ee 
c sd Tata . eel " ¥ it pete ee " Mesto ie La a me ot Sn ASR ee are 
, Fed ad . Et OREN or i Raion Rak Sas 1 4 
4 £ i a’ ; LT de 2 ¥ OH) ‘ ey e bs ' posvevuty ves 9 ane Fo 
; ‘ tp et . teat 3 pas has faye ied pty ie ie haa uae Cnet UAT tees pigeon curs ref, Tate a ae al cate anrety 
4% ‘ 5 “ ~ AS. 7 any lkew, 
; : 8 ee sient Sa Ae Faye PR Lee HAO Hi Sgede. Linares Silat say zs; sh ret os oy Pe Et teh oct de 
' Dh eA ve. . per SA py "eae s nit ee 1a eb ae Sodas BA in ee Boe eT are tne 
; : RUN aC T Sy: MERE Batra nar Coast at ve che Blv-aternestin agnor wig dusigrg grey pn ones 
: + P a4 ae Bot Rayan chy? : Sr tat mad Fe Muar ae mi ae ek its? Past) S deshiessinys , sate Ub de borg ic Sects seer ater ey a 
z <3 a? Ms fa OU ee we Je" 1 46 Se ' ait ete A ‘a°Oy ae bob ebAd "ane i “gare a Pe ae 
a a J tS . erty ‘; x a Pier 8 KETENE ‘" < ys indy a bh Ge ai ack ph on Larba gs Ap 2 
‘ 4 1 V7 t { b irae a Awtsy so She ke Whores, * th th hepa rats 6 westy eee Be jabs. AEN SYA bf Ahisnetoe etd: Las bee re eLD sy sad! {aaah ed Svat eg atin 
: t iftd e of Dd oie ta CAA wie dal Wak a Raine RA as ERG: Det ie roe MD abe g Ye pee Vonit s nda erin Peis % aise tantra ot a Faveiceaprone’ ot 
fi, t J “y fe Js aN a oe fe gio cau dt at my) hy oy wy. ‘ Boi Me rhe $e Y WAP ERK i sane ah es Oke AEE neti edi SELES arr reps 
; ; : 4. is | bat ’ by peat dy. PRY TY. wi poe ; bgt) Main 9 anesat ely ates enererpaare: ea4 ce rear incre 
= : ’ i “s> i. ? . s , ase i ‘a DT tp A 8 t @? i wv & © un Pit at H A AGE eh Se > Addl MASH A yoni t sk Pee Ry Haat ay we ahead idee ¥ eee Msties abelian dei *. ees 
- | § ? r f, ae ¥ ay { Redidear, iste = ae al gage Pil Sechelt saga ne ‘sate i pst tbaitaa ale Le! @ yrs FSB. Pediat payee se epeya 
. ; ie Ay ays RP ‘ TINT 2°8 7D. Pee arbi t oo0k a ‘ 4 head bcd bes 3) a vin iene W) 
I A STM Ue haa ge ray OOeT He ire ate ince kaso doienn aa ater igiaiees ees riage aera 
* , | : ier ee RL TA Late tae noe aD Suleipie toma ae nhipiata PE a oval ta _ ayant bt aaa - 3 z 
: a? : ae ae 3 ¢ ‘ it fs : Deg! ieee liens v apie 
) : Ae 6 he fe QT EAP |S ae “iy ¥ Fle, By Fy nite EAS ate de ents uD Spar bore pptrtiad suas ‘iw & anne rely es Lan di ee. sieyorarert oe eres rary 
’ :. ; Ms of ~ : v' w. — ~ rf ree oe — 
2 a ee bere ee eS Nod 2 ah Fa. Q 74 en Seah ne ies pts Pils Srinhee Sb De Vows ee rn Sane yh af ve es *Siestpe es pce vigor inereetas 
‘ aie sf Se i 43 al 8 aH p%& Br: ¥ Rnd’ , mit ay, AL ae ize Wes Se r) as Aah te yee Sr eor Tykes pA BARE ihe my cite ithal al pode 
’ é f $ wy 3, gin ahi HW a! aie a As ar AB inrees ¥ w Leet RF ” fe. srete nereoeg a Pee | 
. i i ha ad ¥. ine ee tite ee erie 
"j $ ‘ , on : i sores ruse oO desley a iittew vf 
j 1 tk 
F ; 


yp asd ? “9 met pat ya. cpa vonay ety aay SE ta tw 
5 PORTE i ne tt ne , i ¢ . aie ‘a : sip t ye 
: F f. a x Po e i » pS ae oh ’ 8 the. 26 PEN 5 1, : : y ? Rs 
! a i he Eze Oige gis ee BS ot ae 5 
a - 4 Pu. ' Ps ‘ : ¥ es 4 Rites ee ats aL ces vn 


booties hes 
; ic A} a : E 

Ce HELLER ie tes AS ban leulgywiews 

a ate te Tania Hh onan erat Pic Ce ste ie is ya “4d eens = 
aaa te vik eaves iy viel ies aie UES be Said as Sar 
¥ ¥" 2, 
fon we cee ¥: seine evricle wy Ge ede k eee ieeray 
ay: i$ bot : 


PA “ie! vont Shen Olas & two ta praade way eee he 
its, seis Nib k en al Kena er 


OS mre; 
So pevan tally ames RG TLD TASH, 
Fe See OME 
eae ie ERY Prue S 


ean arava ceeeenie 








































aS a oe Seelmy eerie eam 
WER Apes od ‘ Vitel e ms : pe 
a He Te apes sae utes Siete rik Pe a eal hee aad x nsodrerey pid ataie Poetorgine Fs agp at 2A, 
‘ ay ge ach Start Soyiocete aaa S. Gk Oe Rau) Rees dest apie ae ene : pil ch lighattag aM area apd wis Cette) ° 
Fl a fe Fare ite bie erty Be rd 0 fe va eye cores: Grr ; i ge haste Pie eS eRe AF Vibe seats <e.FY ys Pig mie “y, e 
1 AS oth 2 wy oe yy RN “Mf o Sat eee hae angen) ty “ts Aes Shoe! soe Cae Slee ; nine Whip a9 aaa feb lee porie tn * aa 
& as Reabetin ueaets Matta sett igi. Grd ah thes Saudi et Oy Ae nh ee are ‘ 
‘ , % :# . ergs A he ta Teyty bid 2 a & eek reat veg pee it , ‘e > rae ine hte es 4 
a | | oan Rte egal pau a cnr es Tac Usenet iter Sea aa pees 
:Y ; : i > re ‘ pate eh iy Mitre ReMi oe Get ¢ BEC Sn Fle ee ’ Peres nats re Ree pape 
— Ye Pe ey BEY Masso QUE git ae sl te ee ata pe sabe a Sa pps Wetec Broa es Be Ra eists greece Cee ASO veer raed oy rye bes 
ni ‘ ta? As 1 . 15 | 2 é ghey a F pt aie pied bint «Suede can pi.g8 sty i Py . wh i MY a as : 
aq : i ; ie oe 3 pe we}, isa” pi A Rae o wget Lees fa irae Gk Sao DS ee ba esi st Poe eae : 
. | ' , | a ‘" i om " Lay : bi, f; Fis EMI: £v",% : ; TJ, t nie Ext g madly wet RAY: ie ee 
a | ; 5 » 20cm = aft : i 
, y l 
' « ® | 
4 ‘ eh sr aneee ‘get 
| a P5 2 
| Pyrite ; 
i ‘ é > tH 
' t 
e ' 
I 
. é My 4 ' ‘ she 
id ert UU is 3 Winctiseds aN Nee 
, he . tf ve ¢ te de My Pay a 
! R : v +by 4 Tas weee 
4 a3 
t ) ' ve ya 
> a ; i! 


DUTY FTC" Tae 


MC ital i aN 





$ 








NAVAL POSTGRADUATE SCHOOL 
Monterey , California 





THESIS 


AIRCRAFT MANEUVER DETECTION USING 
AN ADAPTIVE KALMAN FILTER 


by 
Meng, Hsing-Han 


December 1989 


Thesis Advisor: Jeti reve =, Burl 





popOroved stor public release; distribution is unlimited 


PO 
e 
NO 

OD 


¢ t™ 





MNCULASSIFIED 
SECURITY CLASSIFICATION OF THIS PAGE 


A 
REPORT DOCUMENTATION PAGE 
Ja REPORT SECURITY CLASSIFICATION tb RESTRICTIVE MARKINGS 
UNCLASSIFIED 7 =r 
Za SECURITY CLASSIFICATION AUTHORITY 3 DISTRIBUTION /AVAILABILITY OF REPORT 
AppDLOved Lor public release: 
CwserGtouEron 15° unlimited 


2b DECLASSIFICATION / DOWNGRADING SCHEDULE 


4 PERFORMING ORGANIZATION REPORT NUMBER(S) 5 MONITORING ORGANIZATION REPORT NUMBER(S) 








6a NAME OF PERFORMING ORGANIZATION 
Naval Postgraduate Schoo 


6b OFFICE SYMBOL 
(if applicable) 


62 
6c. ADDRESS (City, State, and ZIP Code) 7b ADDRESS (City, State, and ZIP Code) 
Monterey, California 93943-5000 Monterey, California 93943-5000 


7a NAME OF MONITORING ORGANIZATION 
Naval Postgraduate School 












Ba NAME OF FUNDING /SPONSORING Bo OFFICE SYMBOL 9 PROCUREMENT INSTRUNVENT IDENTIFICATION NUMBER 
ORGANIZATION (if applicable) 





Bc. ADDRESS (City, State, and ZIP Code) 10 SOURCE OF FUNDING NUMBERS 


PROGRAM PROJECT TASK WORY UNIT 
ELEMENT NO NO NO ACCESSION NO 


Pe codae Security Classification) ATRCRAFT MANEUVER DETECTION USING AN ADAPTIVE 
KALMAN FILTER 


12 PERSONAL AUTHOR(S) 
MENG, Hsing-Han 


13a TYPE OF REPORT 13b TIME COVERED 14 DATE OF REPORT (Year, Month, Day) 15) PAGE COUN 
Master's Thesis FROM CTO 1989 December 96 


pe SUPPLEMENTARY NOTATION The views expressed in this thesis are those of the 
luthor and do not reflect the official policy or position of the Department 
meeeeicnse or the US Government. 
17 GOSATI CODES 18 SUBJECT TERMS (Continue on reverse if necessary and identify by block number) 
FIELD GROUP PoCinonionem racking: Kalman filtering - 
J CL CdMannecuvering 
Pee. 


19 ABSTRACT (Continue on reverse if pes te and identify by block number) | ; 
In the target tracking problem the main purpose is to get an accurate estimation of tar 


yet states. In order to achieve good estimation, the study of target maneuver detection 
is important. 

An estimator that computes a constant input acceleration vector is first derived in 
this thesis. It employs the concept of least square estimation with data consisting of 
Che residuals of the simple Kalman filter. A detector for sensing the target maneuver 
using the input estimates based on a fixed number of measurements is developed. Finally, 
the combination of the estimator, detector, and the simple Kalman filter is developed to 
form a tracker for maneuvering targets. 

The maneuvering target tracker developed experiences problems due to errors in maneuver 
Start-time detection and the computation load associated with using a variable-length 
window to estimate the input. Therefore, a modified input estimation method for tracking 
a maneuvering target is presented. It uses only a fixed number of measurements to com- 











20 DISTRIBUTION /AVAILABILITY OF ABSTRACT 21 ABSTRACT SECURITY CLASSIFICATION 
EX) UNCLASSIFIEDVUNLIMITED (J SAME AS RPT [} DTIC USERS UNCLASSIFIED 


22a NAME OF RESPONSIBLE INDIVIDUAL 22b TELEPHONE (Include Area Code) | z 
mkL, Jeffrey B. 408-646-2390 


JD Form 1473, JUN 86 Previous editions are obsolete SECURITY CLASSIFICAT ©". OF THis FAUE 
S/N 0102-LF-014-6603 UNCLASSIFIED 
1 








UNCLASSIFIED 
SECURITY CLASSIFICATION OF THIS PAGE 


19. continued 


pute the input estimates and employs a scaling factor to correct the input estimates for 
feeding back to a second Kalman filter (used for maneuvering target tracking). The result 
of target tracking using these different methods are presented in this thesis asnd the moc 
fied input estimation method turns out to yield better tracking of manuevering targets in 
some applications. 


UNCLASSIFIED 


iat SECURITY CLASSIFICATION OF THIS PAGE 








Approved for public release; distribution is unlimited. 


Aircraft Maneuver Detection Using An Adaptive Kalman Filter 
by 
Meng, Hsing Han 
Lieutenant, Republic of China Navy 


B.S., Weapon Engineering, 
Chung-Cheng Institute of Technology, 1984 


Submitted in partial fulfillment of the requirements for 
the degree of 


MASTER OF SCIENCE IN ELECTRICAL ENGINEERING 
from the 


NAVAL POSTGRADUATE SCHOOL 
December, 1989 


4 


ABSTRACT 


In the target tracking problem the main purpose is to get an accurate estimation 
of target states. In order to achieve good estimation, the study of target maneuver 
detection 1s important. 

An estimator that computes a constant input acceleration vector is first derived 
in this thesis. It employs the concept of least square estimation with data consisting 
of the residuals of the simple Kalman filter. A detector for sensing the target 
maneuver using the input estimates based on a fixed number of measurements is 
developed. Finally, the combination of the estimator, detector, and the simple 
Kalman filter is developed to form a tracker for maneuvering targets. 

The maneuvering target tracker developed experiences problems due to errors 
in maneuver Start-time detection and the computation load associated with using a 
variable-length window to estimate the input. Therefore, a modified input 
estimation method for tracking a maneuvering target is presented. It uses only a 
fixed number of measurements to compute the input estimates and employs a 
scaling factor to correct the input estimates for feeding back to a second Kalman 
filter (used for maneuvering target tracking). The results of target tracking using 
these different methods are presented in this thesis and the modified input 
estimation method turns out to yield better tracking of maneuvering targets in 


some applications. 
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I. INTRODUCTION 


Most tactical weapons systems require accurate tracking of manned 
maneuverable vehicles such as aircraft, ships, and submarines. The proliferation 
and increasing sophistication of surveillance systems has generated a great deal of 
interest in algorithms capable of tracking a large numbers of objects using 
measurement data from many and possibly diverse sensors. Major advances in 
hardware and algorithms have increased signal processing capabilities by one or 
more orders of magnitude in recent years. This has made the measurement data 
available for tracking even more numerous and complex, creating a demand for 
corresponding advances in information processing techniques to deal with them. 

Tracking is the processing of measurements obtained from a target in order to 
generate an estimate of the target's current State [ Ref. 1. J. In general, tracking 
algorithms require mathematical models of targets and inputs. There are two 
fundamentally different types of inputs, random inputs and deterministic inputs. 
Maneuvering targets can be characterized by an unknown input which can be 
modeled as a random process or assumed to be a nonrandom disturbance, or the 
sum of both. These unpredictable changes in target motion represent a major 
challenge in tracking system design. 

The usual technique applied to the problem of tracking maneuvering targets is 
the Kalman filter. In order to achieve good tracking accuracy for a maneuvering 
target, the target input acceleration must be well modeled when applying the 
Kalman filter. In general, the Kalman filter can yield good tracking for a 
maneuvering target with an unknown random input or a known deterministic 


input. Therefore, the application of Kalman filtering techniques to the problem of 


tracking maneuvering targets generally requires a stochastic forcing function or a 
deterministic input acceleration. If the forcing function is only assumed to be a “ 
white “* Gaussian process, the filter model of target motion may be unrealistic. A 
more realistic approach is to model target motion as the combination of random 
input accelerations and deterministic input accelerations or just the deterministic 
input accelerations. A number of different approaches have been applied to the 
maneuvering target problem [ Ref. 2. ]: 

¢ the target acceleration was modeled as a random process with known 

exponential autocorrelation, 
* maneuver is modeled as an increase in the plant driving noise ( white 
Gaussian sequence ), or 

¢ the acceleration is assumed to be limited to a time-invariant set of discrete 
values and switched values according to a semi-Markov process. The 
acceleration is then estimated by hypothesis testing. 

There are also many additional algorithms developed for tracking a 
maneuvering targets. All of the approaches, as mentioned previously, assume some 
a priori Statistical description of the maneuver, ranging from white noise to 
colored noise to a semi-Markov process. The algorithms work well within the 
context of their underlying assumptions. If the assumptions made do not 
correspond to the actual nature of the maneuvers, filter performance may be 
degraded. 

In this thesis, an algorithm for tracking maneuvering target is presented and we 
assume only that the maneuver is a constant acceleration. The motivation of this 
algorithm came from Fig. 1.1 which shows a typical maneuvering target being 


tracked by two different Kalman filters. In Fig. 1.la, the target is tracking by a 


simple Kalman filter which is a filter with no prior knowledge about the 
deterministic input. The estimated state has some bias relative to the actual state 
after maneuver start. In Fig. 1.1b the estimated state and the actual state of the 
target tracking using the Kalman filter with known deterministic input are almost 
the same before and after the maneuver start and much better than the simple 
Kalman filter. 

The tracking algorithm in this thesis includes an algorithm to estimate the 
unknown deterministic input using the simple Kalman filter and to update the 
simple Kalman filter using the input estimates. The difficulty here is that the time 
of occurrence of maneuvers may be unknown. This problem can be handled by 
making the filter simultaneously perform both target tracking and maneuver 
detection. It seems reasonable to use the observation residuals available in the 
Kalman filter with statistical hypothesis testing to detect the maneuver. When a 
maneuver is detected, the magnitude of the acceleration is identified using a least- 
square algorithm. The result is used in conjunction with a simple Kalman filter to 
estimate the state of the target. 

The aim of the acceleration input estimation is to remove the filter bias caused 
by the target deviating from the assumed zero-mean white-noise random 
acceleration motion. As is well known, bias removal is accompanied by an increase 
in the estimation variance. A detector is used that checks the magnitude of the 
estimated inputs to determine the occurrence of a maneuver. The simple Kalman 
filter is used alone during periods when no maneuver takes place. The method 


mentioned above is called the input estimation method. 


Maneuver tgt. Tracking Using Simple Kalman Filter 


elevation angle ( degree ) 





Figure l1.la Maneuvering Target Tracking Using the Simple Kalman 
Filter 


elevation angle ( degree ) 





Figure 1.1b Maneuvering Target Tracking Using the Kalman Filter 
With Known Input 


Combining the input estimation method and the adaptive Kalman filtering 
algorithm, we can detect the target maneuvering. It is, however, difficult to exactly 
detect the actual maneuver start time. Also, it is hard to get good estimates of the 
unknown deterministic input using a variable length window of measurements 
from the inaccurate maneuver Start time as required by the theory. In addition, the 
computation time when using this variable length window technique to estimate 
input is prohibitive. To overcome the difficulties in the detection and the estimation 
problem, a modified input estimation approach is proposed in this thesis which is 
easier to implement. With this new approach, the bias produced by the maneuvers 
can be removed and better tracking is achieved for maneuvering targets when 
compared with the original method. 

A brief introduction about the Kalman filtering algorithm and target model is 
given in Chapter If. Chapter III presents the algorithms for input estimation, state 
correction, and maneuver Start time detection. Simulation results are presented in 


Chapter [V. The conclusions are in Chapter V. 


Il. TRACKING THEORY 


A. TARGET MODEL 

The target model selected in this thesis is based on the assumption that, without 
maneuvering, the aircraft generally has a zero-mean, white-noise random 
acceleration. If the target was not able to deviate from this acceleration model, 1.e., 
could not maneuver, then the tracking problem could be solved quickly and simply 
using the Kalman filtering algorithm. However, the maneuver capability of the 
aircraft can cause the estimated states to have some biases relative to the actual 
States. 

For the model of the aircraft motion, the state equations are derived for the 
actual continuous time target motion and are then expressed in discrete time 
according to the standard discretization procedure. The model below is presented 
for three-dimensional coordinates in the direction of range, elevation angle, and 
bearing angle. We will use a single spatial variable later in this thesis to simplify 
tracking performance evaluation. This simplification 1s reasonable since the 
estimates in each coordinate axis are nearly independent. The targets under 
consideration normally move in response to a zero-mean, white-noise random 
acceleration consisting of turns, evasive maneuvers and accelerations due to 
atmospheric turbulence. 


The aircraft equations of the motion are modelled as follows: 


X(t) = Fx(t) + Gw(t) (2.1a) 


where 


range 


aircraft | elevation at time t 
bearing 
x(t) = (2.1b) 
range 
aircraft} elevation speed at time t 
bearing 


The continuous-time equations for the aircraft motion in each spatial variable 


are: 
r(t)=w,(t) (2.2a) 
c l 
é(t)=—w,(t) 
r (2225) 
b(t) = an (t) 
r (2220) 


where w, w, and w, are the zero mean, white noise accelerations in range, 


elevation angle and bearing angle respectively. Combining these equations, the 


continuous time state equations for the aircraft motion are 
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The discrete time target equations of motions are 
x(k +1) = O(T) x(k) + P(r, T) wk) (2.4) 


where T is the sampling time and 


For the model in equation ( 2.3 ) it can be verified that 
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where w, iS white Gaussian noise sequence satisfying 


(2.5a) 
(2.5b) 
(2.6) 
(2.7) 
WwW, 
lage 
w, |, 
(253) 


Eiw,} a0 (2.9a) 


o Oo 0 
E\w,w; }=Q,6, = Oc. 0 
Po (2.9b) 


If the available observations are range, elevation angle and bearing angle, then 


the measurement equation is the following: 


: 
rl} f1 0000 0]°| fv 
e|=|0 1 0 0 0 Of? 4]y, 
bi, [0 0 10 0 OF.) {wl, 
5 I, (2.10) 


where y., v, and v, are additive white noise which is due to the noisy measurements 
r € b 


of radar or beacon interrogators and satisfying 


EV, }=0 (2.11a) 
o 0 0 
EW NR Oe ome 0 
Z 
op aoe (2.1 1b) 
When a maneuver occurs, the target model becomes 
X= Ox, + w, + Tu, (2.124) 
Z,=Hx,+Vv, (2.12b) 


where 


ufp= (2.13) 

u Knee 
and ux denotes the deterministic input acceleration generated by a maneuver which 
starts at k=n. Note that maneuvers resulting from a constant input will be addressed 


for simplicity. More general maneuvers can be included in future work. 


B. KALMAN FILTER EQUATIONS 

Equations (2.4) and (2.12a) with ®(T), and I'(r,T) given by equations (2.6)- 
(2.7) and u, by equation (2.13) have the form for which the optimal linear filter is 
identically the Kalman filter. Other filters can, of course, be used to estimate the 
target state vector x,; however, the Kalman filter provides the best performance in 
terms of minimizing the mean square estimation error and generally is easily 
implemented. 


The Kalman filter equations with maneuver input are: 


X yk = Ox, + Tu, 


(2.14) 

Prayn = OP, 2 +TQI’ (2.15) 
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where 


k+/k+1 = minimum mean square estimate of x,,, given observed data up to 


and including time k+/; 1.e., the filtered estimate; 


*e+yk = minimum mean square estimate of x,,, given observed data up to 
but not including time k+J/; 1.e., the one-sample-ahead 


prediction. 


The matrices Pyyiji+1, Pes, are the covariance matrices of the estimation error 


and one-sample-ahead prediction error, respectively. Initially, the calculation of 


Py must be performed before using the Kalman filtering algorithm. The Kalman 


filter is initialized: 


The covariance matrix of the estimation error is then initialized: 
a RCL 
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= E[X>X,_ | 


a Hg > ea | 
Sos 
ee) ie 
Sc) Cc 
Sera 
a eee ce) CS 
Mhooo$o 


= 
Byes oo Sac) CC) 





(2.20) 
Equations (2.14)-(2.17) are presented in flow graph form in Figure 2.1 [ Ref. 
lesb, 


The innovations sequence is defined 


aA 


Le AX, (22) 


I! 


State at tp tate estimate at tz State error covariance at tk 
x xX Pp; 
k klk k/k 


Transition to t a) State prediction 


Xp =Ox, + Pu, tT w, ee) ie Ox gt Pu, 


State prediction covariance 


_ T T 
Peg KE PPP? F1QT 









Measurement prediction 
Faye fon ie 





Innovation variance 


= T 
37 BE oe: ed 


Measurement at 
Filter gain 


t Innovations 
k+] : > y aa 
Bed kei S i+ 


Z —7, Z 
Z t= HX pity pH k+1 k+l] k+I/lk 


Updated state 
estimate 


ay ty ee kek K, 


Updated state 
covariance 


kelikeT AW By PPL 7 





Figure 2.1 Kalman Filtering Algorithm 
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and has the important property that it is a zero-mean, white-noise sequence and is 


Gaussian if the initial state x, and the other noise processes are also Gaussian. Its 


covariance 1s 
EID nZics | ~ E|(Z.. a HX. aa - HX. ) 


=HP,,,,H’+R 


=Si (2.22) 


From Figure 2.1 we see that the calculation of the error covariance matrices is 
independent of the maneuver occurrence. The innovation variance from the simple 
Kalman filter and the one from the Kalman filter with known input will be the 
same. In Chapter III we are going to use the innovations and innovation variance in 


the algorithm to estimate the deterministic input acceleration. 


[3 


II. INPUT ESTIMATION, DETECTION AND STATE 
CORRECTION 


The basic problem posed by a maneuvering target is that there exists a 
mismatch between the modeled target dynamics and the actual target dynamics. 
Provided the target model is correct, the Kalman filter will generate optimum 
estimates of the target motion. However, if the target initiates and sustains a sudden 
pilot-induced maneuver, then the assumed target model is not correct. Unless this 
step discontinuity 1s accounted for, the Kalman filter will accumulate errors and 
possibly lose track. Therefore, something more is required in the tracking 
equations to account for the maneuver event. 

The solution of this problem can be divided up into three different phases. 
First, the maneuver must be detected. Second, the maneuver must be estimated 
based on the simple Kalman filter. Third, the simple Kalman filter state estimate is 
corrected to compenSate for the previous target maneuver. These phases will be 
introduced in the following sections. Input estimation will be discussed first 


because the equations presented will be used in detection. 


A. INPUT ESTIMATION 

The Kalman estimate, X,,:,.,. ( from equations (2.14)-(2.18) ) requires 
knowledge of u,, which is the target acceleration input and is not available to the 
filter. The target acceleration can be estimated and included in the Kalman filter as 
shown below. Let u, = 0 in (2.14), call this the simple Kalman filter, and denote its 


estimate by x,,,,,,,- For simplicity, let 
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Xpayee = Xe (3. 19) 


X payer = Xea (3.1b) 
Prior to time nT no maneuvers occur so that x, =x,. At r=nT the target starts 


to maneuver with a sequence of inputs u,,u u_, where u=U,,U,,,,......U,,, 1S 


atlo°rsees atl? 


a constant input sequence. The simple Kalman filter will continue to give estimates 


according to equation (2.18) with u, =0 


Xie = Xe +K, IZ, a HX... | 


(3.2a) 
where 
X yea = PX ay (3.2b) 
According to equation (3.1a), we have 
X, = OX, _,+K,[Z, -H®x,_, | 
= (I-K,H)®x, _,+K,Z, (3.3) 
Defining 
A, =(I-K,H)® (3.4) 
then equation (3.3) becomes 
x, =A,x,_,+K,Z, (3.5) 


and 
Xe = Xeaye + By Vans a HX, 41 
= 0x, + [Saal Aee = Hox, | 


a (I a K, ,,H)®x, 4 Ky, 2441 
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= Au (A,X,_, v K,Z,)+ Keen 


= A,, ,A.X,-; + Apap pee (3.6) 
and 


Xi42 = (Acar An a Le (A, rAga )K ,Z, + (Ay. )KyZ 


k+1 


+K, 422442 (33) 
Similarly, if the sequence u,,u,,,,......u,,, were known, equation (2.18) would 


give the following estimates 


X ee = Xape- F K,|Z, - Hk, | 


(3.84) 
where 
X pent = PX, 14 + Tuy, (3.8b) 
So, using equation (3.1b), we have 
XK, = Oe, + Tu, +K,[Z, —H(o%,_, +Tu,..)| 
=(I-K,H)(x, , +Tu,_,)+K,Z, 
=(I-K,H)x,_, +(I-K,H)lu,_, +K,Z, (3.9) 
Define 
N, =(1-K,H)r (3.10) 
Using equation (3.4), then equation (3.9) becomes 
x, = A,x,_,+N,u,_, + K,Z, (3.11) 


and 
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Xpa1 = Xesye T Ka Za = Eta 


= (I-K,,,H)@x, +(I-K,H)lu, +K,,,Z 


k+1°~ k+l 


= A,.,(A,%,. +N,u,. +K,Z,)+N,u, +K,,.Z 


k+1°~ k+l 
> (A.A, New as (A,,,N, Ju, + (Nya Ju, 7 (Ay. )\K,Z, 


+K, Zs) (3. 12) 


and 
ies = (A, AA, sae a (APSA aN Ur; a (AgaNa Ju, 
+A, > Ara )K,Z, si ARG INaein a Ko 442 cs. 13) 
Therefore, we have two different estimates of x (x and x) after the occurrence 


of the maneuver, i.e., 


x, =(I-K,H)0x,_,+K,Z, 


(3.14a) 
x, =(I-K,H)ox,_, +(I--K,H)ru,, + K,Z, (3.14) 
Now, define the difference of those two estimates as the following 
Ax, =X,-X, (3.15) 
and recall that 
X, =X, (3.16) 
up to the instant the maneuver occurred, k=n. 
This will yield 
Ax, =(I-K,H)®(x,_, -x,_,)+(I-K,H)lu,, 3.17) 
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Specifically: 

1. For & < n, 1.€., no maneuvering, we have x,,=x,_, and u,_ =Omse 
AX Oe 

2. For k = n, 1.e., when the maneuver just occurred, we have x, , =X,_, ( 
because n-/ <n) and u,_, =0 which is prior to the maneuver start, so Ax, =0 1s 
still zero. 

3. For k > n, 1.e., the maneuver has occurred, we have x,_,—X,_, =AX,_, 


and u,_, =u,SO 
Ax, =(I-K,H)®(x,_, -—x,_,.)+(I-K,H)ru,, 


=(I-K,H)®Ax,_, + (I-K,H)lu 


=(I-K,H)(®Ax,_, + Tu) (3.18) 
In summary, we have 
0 Ke Seon 
Me (3.19) 
(I-K,H)(®Ax,_, + Tu) k > n 


Next, we are going to find a general relation between the estimated state with 


the maneuver and the one without the maneuver. At time ¢, =t 


n+1? 


equation (3.19) 
yields 


Ax,., =(I-K,,,H)(®Ax, +Tu) 


(3.20) 


From equation (3.19) we know that Ax, =0 , so equation (3.20) becomes 


Ax,,, =(I-K,,,H)lu 


eRe 
Define 


Mu =I- K,,,H (3.22) 
then, 


AX 4) = Menu (3.23) 


atl 


From equations (3.19) and (3.23) for k > n, we have 


Ax, =(I-K,H)(®Ax,_, +Tu,_,) 


kon (3.24) 
Define the general equation 
Ax, = M,lu (3.25) 
then, equation (3.24) becomes 
M,lu=(I-K,H)(®Ax, _, + Tu) 
M,lu=(I-K,H)®(M,_Ju)+(I-K,H)lu 
hence, 
M, = (I-K,H)(®M,_, +1) een (3.26) 


It is obviously from equations (3.19) and (3.23) that when there is no 
maneuver, 1.e., the time prior to maneuver, 
M, =0 (k<n (3.27) 
Therefore, from equations (3.15), (3.23), (3.26) and (3.27) we have 
x, =x,+M,.u (3.28a) 


where 


Jey, 


M,= 


(I-K,H)(®M,_,+1) i SS Fo 


(3.28b) 


The observed value of the residual sequence Z (with unknown maneuver) can 


be related to the innovations residual sequence Z (i.e., if u were known) using 


equation (3.28) 
Z, = Z,—Hx,,_, = Z, —H®x,,, 


Z, =Z, -Hi,,., =Z, -H®%,_, - Hu, 


For different values of k, we have 


~ 


1. For k < n, because u,_, Z, 


aA 


=(), 
2. For k = n, because u,_, =0, 


N 


k— © 


3. For k > n, because u,_, =u, 
Z, —Z, =(Z, -H®x,_,)-(Z, —H®%,_, - HT u,_,) 
=HO(x,_,-x,_,)+HTu 


= H(®M,_,+Dlu 


hence, 
Z, =Z,+H(OM,_,+1)ru neon 
Defining 
B, = H(®M, + DP 
we can have 


2 0 


(3.29a) 


(3.29b) 


(3.30) 


G35 


Z,= (3732) 


~ 


Z,+B,_,u koe eh 


Since we are only interested in estimating the input acceleration u, for 


k=n4+1,n+2,...... yn+s we have 
Las / ie B,, 
Z 7 B, 
mee = Linea Ep 1 u 
Lins Se Bia s-t (3.33) 
Defining 
Bere / ba 
Y = Ln42 € = Le 
Be. Tie 
B, HI 
: Be H(®M,,,, ~ ae 
Bie H(®M,,.- I Ir (3.34) 
then equation (3.33) becomes 
Y=Bu+e (3.35) 


The covariance of €, using the innovation covariance from the simple Kalman 


filter in equation (2.22), is given by 


% | 


yee (3.36) 

The problem now is to estimate the unknown input acceleration u in equation 
(3.35) using the concept of least-square estimation. Since the elements of the 
vector € are independent and zero-mean with covariance ©, we can find the 


estimate, u, by minimizing the quadratic error 


J=[Y —Bu]’(2)'[Y—-Bul] (3.37) 
The input acceleration estimate that minimizes equation (3.37) is obtained by 


setting the gradient with respect to u equal to zero 


VJ =0 (3.38) 
yielding 
2B'x"[Y -Bu]=0 (3.39) 
The estimated input acceleration is 


a _[plo-ip)' prs 
a=(B’Z"B] B’Z"Y (3.40) 
Since the elements of € are independent, zero-mean random variables with 


covariances >, the least-square estimate is unbiased, 1.e., substituting equation 


(3.35) into (3.40) yields 
A = = ae 
E[a]=[B’2"B] B'S E[Bu+e]=u (3.41) 


The estimation error 1s 


=-[B’="B] B’Z"e 


(3.42) 
Thus the mean-square error, i.e. the covariance of the error, is 
= eon | 
To-lp] pT y-lyy-! Ty-ip]"! 
=|B’Z"B] B’Z"rr"B/BE BI 
_fpre-ipT! 
=|B'x"B| (3.43) 


To calculate the input estimate, the previous s measurements must be stored to 
perform the calculation and the maneuver is assumed to occur at the beginning of 
those s measurements. The measurements could be used in two ways. One is to 
compute the input estimates for maneuver detection using a fixed-length window of 
measurements. The other way is to estimate the deterministic input from the 
detected maneuver start time using a variable-length window of measurements. In 
either way, the information needed to compute the input estimates are the residuals 
from the simple Kalman filter, the covariance of these residuals, and the weighting 
function, B,, computed in equation (3.34). Therefore, to estimate the input 
acceleration requires only results from the simple Kalman filter, i.e., there is no 
need to have the prior knowledge of the input acceleration. 

The input estimation algorithm consists of the estimation of the unknown input 
(maneuver) using the residuals from the simple Kalman filter starting when the 
maneuver starts. The maneuver onset time is still unknown. Methods of detecting 


the maneuver Start time will be discussed in the following section. 
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B. DETECTION 

The estimation algorithm developed in the previous section requires 
knowledge of the maneuver start time. Detection is the process of detecting the 
maneuver start time. This section develops the detection algorithm. 


The innovations and its covariance are 


iia = Zu — BX ay (3.44a) 


Sin = eU seay o | +R (3.44b) 


for the nonmaneuvering case. On the contrary, when a maneuver occurs the 


corresponding innovations and its covariance are 


Lbs ag = 1 re a biXeegre = ee — H®x 


Pam all (3.45a) 


a 


Sin = HP,..,nH’ +R (3.45b) 


Therefore, as a result of the maneuver, the residual sequence remains a white-noise 
process having the same variance as S,,,, but now it has a nonzero mean. When a 
maneuver occurs, or if a nonlinearity develops, it manifests itself as a bias in the 
residual sequence. Thus, to detect the occurrence of the maneuver, it 1s necessary 
only to monitor the bias. As long as no bias develops, we continue to use the zero- 
mean white-noise acceleration tracker; when a bias is detected, then we switch to 
the input estimation tracker. 


Mathematically, detecting the bias reduces to the following hypothesis test: 


aA 


ie No Maneuver Occlinsesn—eee 


fe Maneuver Occurs : Z, = Z =) Sa (3.46) 


where Z, is zero-mean, white noise with variance S,. 
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Detecting a maneuver is equivalent to detecting the presence of a deterministic 
signal of unknown amplitude and time of arrival in a background of zero-mean, 
white noise. Since the measurement noises are assumed to be Gaussian, then the 
optimum test for deciding upon H, or H, is the generalized likelihood ratio test. 

The estimation of the input is done according to equation (3.35) using a fixed 
number of measurements for the detector. An estimate is accepted, i.e., a maneuver 
is declared detected, only if it is “statistically significant”. Therefore, we must find 
a test statistic and compare it with a given threshold to see if there is a maneuver has 
occurred. In equations (3.36) and (3.40) the estimated input is unbiased with 
covariance o”. Using the theorem of hypothesis testing with significance [{ Ref. 3. ], 


consider the significance test for the estimate u is 


ju] > 7H (3.47) 
where TH is a threshold. 
The threshold is selected by noting that if the input is zero ( u=0 ), then 


the mean of u is also zero and u_ should have the following density function 


a ~N(0,0°) (3.48) 


and TH is chosen such that the probability of false alarm is 


pill = TH } = (3.49) 


with @=10~ or smaller. 

The value of TH and the probability of detection can be obtained from tables, 
given the probability of false alarm, P,,. The performance of this detector is 
characterized by the probability that a maneuver is correctly detected when it 
occurs, P,, and the probability that it erroneously declares a maneuver when, in 


fact, nO maneuver was undertaken, P.,. For example, if the probability of false 
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alarm is 0.01%, i.e., confidence level is 99.99%, then the threshold value can be 
determined from the table of normal distribution function with such probability of 
false alarm. The threshold value corresponds to P,, = 0.01% is 3.890. Therefore, 
as soon as the input estimate is calculated, its absolute value is compared with the 
threshold to see whether a maneuver has occurred. 

The calculation of the input estimate G assumes that the maneuver starts s 
measurements ago. It is necessary to go back and compute the input estimates based 
on a variable length of measurements and correct the state estimate of the simple 
Kalman filter using the estimated input once the maneuver is detected. The detected 
maneuver start time may not be the same as the actual maneuver start time. Because 
the bias is monotonically increasing with time, the estimated input does not have a 
sudden jump at the time of maneuver start. The way to overcome this problem is to 
find a relation between the delayed maneuver start time and the estimated input. 
We can use this relation to yield a mapping to correct the detected start time. 
Although the detector is not optimal, it should perform well in a practical 


operational environment. 


C. STATE AND ERROR COVARIANCE CORRECTION 
When a maneuver Is detected, the state and error covariance must be corrected 
as follows [ Ref. 3. ]. 
1. State Correction 
All the information gained from the previous sections is now available to 


correct for the target's maneuver. Recall from equation (3.28) that 


xX = 7 


where 
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(I-K,H)(®M,_,+1) Jems? Jee 


So, the simple Kalman filter estimate is corrected or updated by a 


through the equation 


XK been = Xpe641 +M,lu (3.50) 
where x“x+s+: denotes the updated estimate at time (k+5+1)T. 


Since u is unbiased, taking the expectation in equation (3.40) shows that 


1b rere a| (3.51) 
Thus, the correction will remove the bias in Xgss41. 
2. Error Covariance Correction 
The bias removal is accompanied by an increase in the estimation 
variance. A new covariance estimate must be computed to reflect the change in 


equation (3.40). Subtracting the correct value from the estimated value, i.e., 


subtracting equation (3.40) from (3.28), we find that 


X beset = Xevses tM, (u-u) (3.52) 
where the assumption u,,,=u for /=1 to Sis used. 


Recall from equations (3.35), (3.40) and (3.43) that 
a=(B’Z"B] B’Z7Y 
=LB’2" (Bute) 


= LBS 'Bu+LB’ de 
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= + UR se 


ence. 


u-u=LB’L"e Gis5) 


The input estimation error, O—u, iS uncorrelated with X,,.,,—Xjs¢4; 


u 
k+s+1 


because the innovations form a white noise sequence. Thus, the covariance of x 
iS 


T 
u _ u J u = 
k+s+] L(t. Xin leeeee SoH) 


=p 


k+s+1 


+(M,I)L(M,r)" 3.54) 
where (M,I)L(M,I’)’ represents the increase in variance as a result of updating 
X,..,, using &. Whenever updating occurs, (M,I)L(M,I’) must be added to the 
value of P in equation (2.16) causing a corresponding increase in the Kalman gain. 
A maneuver is considered finished when the input estimate based on 
measurements from the sliding window of fixed length s becomes insignificant. 
The length s is a design parameter, as mentioned in Section B. We need to find a 
appropriate value of s in order to produce a reliable estimate. We are going to 
examine this issue by using a simulated maneuvering target model in the following 


chapter. 
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IV. IMPLEMENTATION AND SIMULATION RESULTS 


The integration of the estimator, detector, and the simple Kalman filter into a 
tracking scheme is straightforward. The simple Kalman filter is first put into 
operation and the estimator and detector are activated when the filter is near 
Steady-state. In this chapter, we generate a maneuvering target model and use this 
model to exercise the input estimation and detection algorithms which were 


mentioned in the previous chapters. 


A. THE TARGET MODEL 
The target model equations are given in Chapter II. The parameters T =1 sec, 
Q=0.1, R=2 degree2 are used in these equations. The initial conditions of the 


estimate are taken to be the first measurement, 1.e., 


x(0)=Z(0) degree, x(0)=0 
The formula for the initial covariance matrix P(0/0) is given in Chapter I, 
with the given variance of the elevation angle ( 0? =2 ) and the variance of 


é 


derivative of the elevation angle ( o7 =3 ) 


P(0/O)=|2 0 ; 0 3] 

The target starts a constant acceleration at T = 300 seconds and maintains this 
maneuver till T=600 seconds Using the MATLAB program elevsim.m, we can 
simulate this maneuvering target. Figures 4.1a and 4.1b show the state estimates 
(the elevation angle and the derivative of elevation angle) from the simple Kalman 
filter versus the states of the actual target. We see that the estimated states have a 


bias relative to the actual states after the maneuver starts. The state estimates 
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Figure 4.1b Velocity Tracking Using the Simple Kalman Filter 
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from the Kalman filter with known input versus the actual target states are shown 
in Figures 4.2a and 4.2b. We see that the estimated states, using the Kalman filter 
with known deterministic input, and the actual states are almost the same before 
and after the maneuver starts. Note that the estimated states in Figure 4.2 are much 
better than the estimated states in Figure 4.1. Figures 4.3 and 4.4 show the error 
covariance and the filter gain for each time step for both of the Kalman filters. 
Figures 4.3 and 4.4 demonstrate that the time for both Kalman filters to converge 
to steady-state is the same and both have the same error covariance. From the 
above figures, we can easily see that the estimated states of the two different 
Kalman filters are greatly different due to the maneuver. In the following sections, 
we are going to use this example to perform the input estimation and input 


detection algorithms. 


B. ESTIMATOR AND DETECTOR 
In applying the input estimator and detector to a tracking scheme, two factors 
need to be considered. The number of measurements 5 used to estimate u for the 
detector and the value of the threshold (TH) in the detector [ Ref. 3. ]. We will 
explain this statement in the following sections. 
1. Determine the number of measurements to compute input 
estimates 
When computing the input estimate, it is assumed that the input 
acceleration is constant for a period of time. Therefore, the input can be detected 
using a sliding fixed-length measurement window of length s. To assess the 
performance of the least squares estimator and to provide a guide for selecting s, 
the following experiment was performed. A nonmaneuvering target, 1.e., u=0, 1S 


tracked by a simple Kalman filter and the input estimate, u, 


3) 1 


Real vs. K. F. with Known Input 


SS 


ae 
© 
3 
~~ 
a 
OD 
= 
< 
= 
oS 
‘oO 
os 
> 
ae 
tL) 


I 
a) 


300 


k ( seconds ) 


bho 
S 





Figure 4.2a Position Tracking Using the Kalman Filter with Known 
Input 
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Figure 4.2b Velocity Tracking Using the Kalman Filter with Known 
Input 
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Figure 4.3b Error Covariance P12 from the Simple Kalman Filter 
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Figure 4.3d Error Covariance P22 from the Simple Kalman Filter 
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Figure 4.4a Filter Gain K11 from the Simple Kalman Filter 
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Figure 4.4b Filter Gain K21 from the Simple Kalman Filter 
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is computed from equation (3.40) for different values of s. Figures 4.5a and 4.5b 
show the estimated input for the nonmaneuvering target for two different values of 
s. For the larger value of s, the variation of the estimated input is reduced when 
compared with the smaller value of s. Table I summarizes the statistics of the 
estimated inputs for different values of s. As expected, the standard deviation of 
input estimates ( uest ) decreases with increasing values of s. Table I can be used to 
select a suitable value of s. Figures 4.6a and 4.6b also illustrate the effects of 
different values of s on the input estimates for the maneuvering target. They show 
similar results to those in Figures 4.5a and 4.5b. The choice of s determines the 
accuracy of the least squares estimate, i.e., the accuracy increases with the number 
of measurements. However, large values of s will create the problem of a long 
memory in the estimator and reduce the importance of the most recent 
measurements. Therefore, we use 5 equal to 50 measurements for this thesis in the 
simulation runs. The program used to generate these results 1s elevdetecl.m. 
2. Determine the threshold ( TH ) 

From Table I, we see that the estimated input u has a standard deviation 
equal to 0.9183 when using 50 measurements. The threshold value can be 
determined from this number. We choose the TH to be greater than 3.89 times the 


standard deviation, 1.e., 


TH > 4.24 x 0.9183 = 3.893 
This choice of threshold was found by setting the false alarm rate smaller 
than 0.01%. The next step is to perform the detection algorithm with this threshold 
value. Figure 4.7 shows the result that for this particular target with 50 


measurements to compute input estimates, we can detect that there is a 
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Figure 4.5b U Estimates of the Nonmaneuvering Target ( s=50 ) 
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Table I Statics of Input Estimates for the Nonmaneuvering Targets 
Using Different Numbers Of Measurements 
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Figure 4.6b Input Estimates of the Maneuvering Target ( 50 samples ) 
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Figure 4.8 U Estimates Using the Variable Length Window 
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maneuver Starting at k=363 seconds. This result comes from program 


elevdetec.m. 


C. DETERMINE ERRORS IN DETECTED START TIME 

Although we have detected the maneuver Start time at k=363 seconds in the 
example displayed in Figure 4.7, it is not the true maneuver start time. Errors in 
the maneuver start time will cause errors in the estimated input. In order to find 
this error we can apply a variable length window to compute the input estimates 
once the maneuver starts. We assume a false maneuver start time several time steps 
later than the actual maneuver start time and then perform the simple Kalman filter 
and start the input estimation algorithm with a variable-length window. The result 
for a false maneuver start time at k=315 seconds is shown in Figure 4.8 and its 
sample mean value (averaged from k=399 to k=599 seconds) is equal to 3.2131. 
The large values of the input estimates between k=315 to k=400 seconds, in Figure 
4.8, are due to the short length window used in the beginning of the input 
estimation computation. Better estimates are obtained when the window becomes 
long enough. Table II summarizes the results taken over 20 computer runs for 
different false maneuver start time. Those results are from program 
IE_sensitive.m. From this table we can determine a mapping to correct the u 
estimate for errors in detected maneuver start times. This corrected input estimate 


can be used to update the states of the simple Kalman filter. 


4) 


Table II U Estimates Using the Variable Length Window For 
Different Maneuver False Start Times 


Different False Maneuver Start Time 


MPF=305 | MPF=310 | MPF=315 | MPF=320 | MPF=325 
| 2.9568 | 
| 2.9973 | 








Run 

2.9568 
Spill 3.8521 
36m 
3.7537 


2.9973_| 3.0807 | 3.3051 | 3.3983 | 3.5190 | 3.8037 
3.0144 | 3.1770 | 3.3063 | 3.4228 | 3.6264 | 3.8096 
. 


# F= 
i | 
2.9685 | 3.1289 | 3.2284 | 3.3757 | 3.5702 | 3.7076 
3.0496 3.2813 3.4672 | 3.5679 | 3.7769 
10 3.0340 | 3.2192 | 3.2646 | 3.4504 | 3.6770 | 3.7500 
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3.8347 
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0.0359 0.0512 0.0432 0.0404 0.0588 0.0524 


Jeo hs fey) Sighs Sp lie) 3.4022 3.608 1 3.6991 











42 


D. FINAL RESULTS 

Once the maneuver Start time is detected, we are going to update the state and 
error covariance as given in Chapter III, Section C. In addition we have tried 
several different approaches suggested in the course of this research. 

1. Method A 

This method is based on the original idea mentioned in Chapter III. It 

updates the state and error covariance as given in Chapter III as soon as the absolute 
value of the estimated input becomes greater than the threshold value. Program 
elevesdcr.m performed this method. Figure 4.9 shows the target track using this 
method and Fig. 4.10 shows the square difference of the estimated target states 
from the Kalman filter with known input and the estimated states from method A. 
As Figures 4.9 and 4.10 show, method A apparently is not effective in keeping the 
position and velocity errors small. On checking, it soon became apparent that this 
was because the residuals from the Kalman filter including input correction are 
used in the input estimation algorithm. In turn, this produces transients and large 
errors. This led us to revise our strategy slightly. 

2. Method B 

This method tried a different way to update the state and error 

covariance. It updated the state and error covariance based on Chapter III only 
when the absolute values of the estimated input is not greater than the threshold 
value. Program elevesdcr_a.m performed this algorithm. Figure 4.11 and 4.12 
show the result. As we can see, the errors produced by this method are quite small 


comparative to the results of method A. 
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Figure 4.9b Velocity Estimates Using Method A 
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Real vs. Kalman w/ Known input 
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Figure 4.10a Position Error Squared Using the K.F. with Known 
Input 


Real vs. Kalman + Input Est. 
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Figure 4.10b Position Error Squared Using Method A 
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Real vs. Kalman w/ Known input 
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Figure 4.10c Velocity Error Squared Using the K.F. with Known 
Input 


Real vs. Kalman + Input Est. 
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Figure 4.10d Velocity Error Squared Using Method A 
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Figure 4.11b Velocity Estimates Using Method B 
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Real vs. Kalman + Input Est. 
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Figure 4.12b Velocity Error Squared Using Method B 
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3. Method C 

Since it is hard to detect the true maneuver Start time, we can use a new 
scheme to solve the tracking problem. In this method we track the target using a 
simple Kalman filter to generate the estimated input using a fixed number of 
measurements and then feed this estimated input back to a second Kalman filter. 
The results are shown in Figures 4.13 and 4.14 which is not a very good tracking. 
The reason is shown in Figures 4.15, we see that the estimated input has a transient 
that lasts for about 300 samples and the final value is quite large compared to the 
true input ( u=3g ). Therefore, we need a factor to scale down the estimated input 
and Figure 4.16 shows the result for a factor equal to 


magnitude_of _true_input 


actor = 
factor =~ ean(uest(600:999)) 


(in this example, the factor is 0.1209). The scaled input estimates are shown in Fig. 
4.17. The squared position and velocity error are shown in Fig. 4.18. Comparing 
Figures 4.16 to 4.18 with Figures 4.9 to 4.12, we see that using the scaled input 
estimates in the Kalman filter yields better tracking. This method provides an 
easier way to solve the tracking problem. We can find a value of the scaling factor 
as a function of the number of measurements. This method has biases that last for 
about 300 time steps, then the estimates will be close to the actual states. Table II 
shows the scaling factor for different magnitudes of true input and for different 
numbers of measurements.From Table III, it is easily seen that the scaling factor 
only depends on the number of measurements which were used to compute the 


input estimates (not on the input magnitude). Therefore, we can use this table to 
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SKF + Modified Input Est. 
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Figure 4.13a Position Estimates Using Method C 
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Figure 4.13b Velocity Estimates Using Method C 
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Figure 4.14a Position Error Squared Using the K.F. with Known 
Input 


Real vs. Kalman + Input Est. 
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Figure 4.14b Position Error Squared Using Method C 
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Figure 4.14c Velocity Error Squared Using the K.F. with Known 
Input 


Real vs. Kalman + Input Est. 
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Figure 4.14d Velocity Error Squared Using Method C 
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Estimated Input 
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Figure 4.16a Position Estimates Using Method C ( with factor ) 
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Figure 4.17 Scaled U Estimates 
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Real vs. Kalman + Input Est. 
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Figure 4.18b Velocity Error Squared Using Method C (with factor) 


a8, 


determine the scaling factor for the estimated input based on the number of 
measurements and apply the scaled input estimates to the simple Kalman filter to 


yield better tracking accuracy. 


Table III The Scaling Factors For The Estimated Inputs 


a eee Magnitude of the true input 
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V. CONCLUSION 


In this thesis, a method of tracking a maneuvering target has been presented. 
This scheme incorporates a simple Kalman filter, an input acceleration estimator, 
and a detector. In order to get accurate tracking of the maneuvering target, we 
need to detect the maneuver start time and apply the estimated input to the simple 
Kalman filter. The input estimator presented in this thesis generates good estimates 
of the unknown input acceleration when using a sufficient number of 
measurements. The detection of the maneuver start time is difficult; it is always 
biased by a time delay and most of the time spent on this thesis was spent on 
determining an accurate start time. We can use the variable-window to correct this 
time delay bias. Once we find the correction factor based on Table II, the estimated 
input can be updated to approach the true input and the maneuver start time could 
be reset. The detection algorithm in this scheme requires a significant amount of 
computation and memory, although it is simple in concept. The advantage of the 
detection algorithm is that it is implementable without any a prior knowledge of 
the maneuvering characteristics of the target. 

Since it 1s hard to detect the exact maneuver start tme, we have modified this 
tracking scheme slightly. We use the simple Kalman filter to generate the input 
estimates using a data window of fixed length. In order to produce reliable tracking 
of the maneuvering target, the estimated input must be scaled to the true magnitude 
of the input acceleration. Fortunately, Table III provides us a way to do this. The 
scaling factor can be easily determined and depends only on the number of 
measurements which are used to compute the input estimate. Therefore, as shown 


in Fig. 4.16, this new method can yield good tracking accuracy for the constant 


ay 


acceleration considered in this thesis. There still exists some biases at the time of 
maneuver initiation, but this dies out eventually. Since we use a one second 
sampling time in this thesis, the time for the biases to be vanished is about 3 minutes 
which is not practical in some applications. However, this method can be applied in 
applications with higher sampling rates. 

The analysis in this thesis assumed a very specific situation, viz., a two-state 
one-dimensional elevation angle tracker. A future step is to incorporate the 
methods mentioned in this thesis into a realistic three-dimensional tracker as 
mentioned in Chapter II. Also, it 1s important to generalize these methods to 


account for different maneuver models. Further reductions in the computation 


load are possible if the coefficients M, can be assumed to be time-invariant or 


otherwise vary slowly with time, allowing the M,'s to be precalculated. This would 


greatly simplify the required real-time processing load [ Ref. 4. ]. 
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Se ee ee 


APPENDIX 


COMPUTER PROGRAMS 


ELEVSIM.M Maneuvering and nonmaneuvering target. simulation 

ELEVTRACK.M Uses the simple Kalman filter and the Kalman filter 
with known input to track the target. 

ELEVDETEC!.M Computes the input estimates for the different targets. 

rie YDETEC.M Performs the detection algorithm. 

JE_SENSITIVE.M Computes the errors for false maneuver start times. 

ELEVESDCR.M Tracking solved by Method A. 

ELEVESDCR_A.M _ Tracking solved by Method B. 

ELEVESDCR_D.M _ Tracking solved by Method C. 

ELEVESDCR_D1.M_ Sub-program of ELEVESDCR_D.M 


ie, 


1, ELEVSIM.M 


% File Name : elevsim.m 

%o 

% Purposes : 

%  1.Simulate the unmaneuvering and maneuvering target 
% 2.Elevation angle only. 

Jo 

% By : Meng, Hsing-Han 


clear 

cle,disp(’ oe 

fname=input('Give the name for the target ? ',’s’); 
N=input(‘Give the total number of data ? '); 
MP=input(‘Give the time to start maneuver : '); 
amp=input(Give the magnitude of input : '); 


% TARGET SIMULATION 


rand(‘normal’); 

n=ieN: 

ValewesUal: 

Vane 2: 

w=] *sqrt(var_we)*rand(n); 
v=sqrt(var_e)*rand(n); 

u=[zeros(1,MP-1) amp*ones(1,N-(MP-1))]; 


Tei: 

phi=[1 T;0 1]; 
Hao} 
x(:,1)=[23;0]; 
ZH xt evil): 
x_manu(:,1)=[23;0]; 
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z_manu(1)=H*x_manu(:,1)+v(1); 
gam=[(T%2)/(2*1000);T/1000]; 
gam_manu=gam; 


for k=1:N-1 
x(:,k+1)=phi*x(:,k)+gam*w(k); 
z(k+1)=H*x(:,k+1)+v(k+1); 
X_manu(:,k+1)=phi*x_manu(:,k)+gam_manu*(w(k)+u(k)); 
z_manu(k+1)=H*x_manu(:,k+1)+v(k+1); 

end 


% PLOTTING 


iN: 
for j=1:2 

clg 

subplot(211),plotG,xQ,:)), grid 

subplot(212),plot(i,x_manu(j,:)),grid,pause 
end 
clg 
subplot(211),plot(i,z), grid 
subplot(212),plot(i,z_manu), grid,pause 
clg 


% SAVE TO WORKSPACE 


eval(['save ',fname,_u x z N MP’}) 
eval(['save ',fname,__m x_manu z_manu N MP’]) 
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2. ELEVTRACK.M 


% File Name : elevtrack.m 

%o 

% Purposes : 

% 1. Track the unmaneuvering and maneuvering target 
% 2. Elevation angle only. 

Jo 

% By : Meng, Hsing-Han 


clear 

cle,disp(’ ‘)3 

fname=input('Give the name of target to be processed ? ','s’); 
amp=input('Give the magnitude of input : '); 

eval([{‘load ',fname,_m’‘]}); 

X=x_manu; 

Z=Z_manu; 


% INITIAL CONDITION 


var_we=0.1; 

Valmie =: 

Vapecd—>. 

u=[zeros(1,MP-1) amp*ones(1,N-(MP-1))]: 
(tN: 

phi=[1 T;0 1]; 

H=[1 0]; 
gam=[(T%2)/(2*1000);T/(1000)]; 
l=eve(Z): 

Q=var_we; 

Rear eC: 

xe(:,1)=[z(1);0]; 
xem(:,1)=[z(1);0]; 
P=diag([var_e var_ed]); 


Pm=diag([var_e var_ed]); 
i=0; 


% TARGET TRACKING 


for k=1:N-1 
Pp=phi*P*phi+gam*Q*gam’; _% Simple Kalman Filter 
xp=phi*xe(:,k); % only info. we have 
S=H*Pp*H'+R; 
K(:,k)=Pp*H *inv(S); 
P=(I-K(:,k)*H)*Pp; 
lei,kK)=P1,1): 
reae(2,k)=P(1,2); 
tno, k)=P(2,1); 
PP(4,k)=P(,2); 
inov(k+1)=z(k+1)-H*xp; 
xe(:,k+1)=xp+K(:,k)*inov(k+1); 


Ppm=phi*Pm*phi'+gam*Q*gam';  % Kalman Filter with Input 
xpm=phi*xem(:,k)+gam*u(k); — % can't use for real world 
Sm=H*Ppm*H'+R; 
Km(:,k)=Ppm*H'*inv(Sm); 
Pm=(I-Km(:,k)*H)*Ppm; 
PPm(1,k)=Pm(1,1); 
fem 2 .k)=Pm(1,2); 
PPm(3,k)=Pm(2,1); 
PPm(4,k)=Pm(2,2); 
inovm(k+1 )=z(k+1)-H*xpm; 
xem(:,k+1)=xpm+Km(:,k)*inovm(k+1); 
end 
eval({‘save ',fname,'_trk xem xe x;']); 


% PLOTTING 
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j=I:N; 
plotG,x(1,:),j,xe(1,:),Jj,xem(1,:)),grid,pause 
plotG,x(2,:),j,xe(2,:),j,xem(2,:)),grid,pause 
plot(PP(1,:)),grid,title(Covariance of P11’),pause 
plot(PP(2,:)),grid,title(Covariance of P12'),pause 
plot(PP(3,:)),grid,title(Covanance of P21'),pause 
plot(PP(4,:)),grid,title(@Covanance of P22'),pause 
plot(K(1,:)),grid,title( Filter Gain of K11'),pause 
plot(K(2,:)),grid,title( Filter Gain of K12’),pause 
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3. ELEVDETECI.M 


% File Name : elevdetecl.m 

Jo 

% Purposes : 

% 1. Apply input estimation algorithm 
% 2. Compute the input estimates 

% 3.Elevation angle only. 

%o 

% By : Meng, Hsing-Han 


clear 
cle,disp(’ i; 
fname=input(‘Give the name of target to be processed ? ','s’); 
tgmod!=input(’Maneuver or unmaneuver target ? [m]/[u] ',’s'); 
s=input( How many points of measurement want to use ? '); 
if tgmod!=='m' 

eval([‘load ',fname,'_m’]); 

K=x_manu; 

Z=Z_manu; 
else 

eval([‘load ',fname,'_u’']); 
end 


% GET RID OFF THE FIRST FEW TRANSIENT POINTS 
cpt=10; 


% TARGET TRACKING 


var_we=0.1;: 
wapee=2:, Var_ed=3; 
|: 

phi=[1 T;0 1]; 

=|) O]; 
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gam=[(T%2)/(2*1000);T/(1000)]; 
l=eyve(Z), 

Q=var_we; 

R=var_e¢; 

xe(:,1)=[z(1);0]; 

P=diag([var_e var_ed]); 


i=0;j=0; 

for k=1:N-1 
Pp=phi*P*phi'+gam*Q*gam’;| % Simple Kalman Filter 
xp=phi*xe(:,k); % only info. we have 


w(k)=H*Pp*H'+R; 
K(:,k)=Pp*H'*inv(w(k)); 

SCE A) ie) roy 
inov(k+1)=z(k+1)-H*xp; 
xe(:,k+1)=xp+K(.,k)*inov(k+1); 


J COMPUTE THE ESTIMATED INPUT 
if k>(cptts-1) 
M=0; 
for i=1:s 
AQ, 1)=H*(phi*M+I)*gam; 
M=(I-K(.,k-st+i)*H)*(phi*M+I); 
Sinv(1,1)=Inv(w(k-s+1)); 
end 
C=A'*Sinv; 
uest(k)=inv(C*A)*C*inov(k-s+1:k); 
end 
end 


% PLOTTING 


ss=num2str(s); 


plot(uest), grid,title({‘Tgt1. ',ss,,100 measurements to compute U estimate’) 
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xlabel(‘k'),ylabel((U estimate’),pause 
max(abs(uest)) 

mean(uest) 

std(uest) 


Jo SAVE TO WORKSPACE 


if tgmodl=='m' 

eval([{'save ',fname,ss,'_est’}); 
else 

eval([{'save ',fname,ss,'u_est']); 
end 


67 


4. ELEVDETEC.M 


% File Name : elevdetec.m 

Jo 

% Purposes : 

% 1. Apply input estimation algorithm 
% 2. Compute the input estimates 

% 3. Perform the detection algorithm 
% 4. Elevation angle only. 

Jo 

% By : Meng, Hsing-Han 


clear 

cle,disp(’ Te 

fname=input(‘Give the name of target to be processed ? ','s’); 
s=input(How many points of measurement want to use ? '); 
eval({‘load ',fname,__m‘]); 

X=X_manu; 

Z=Z_manu; 


% GIVE THE THRESHOLD VALUE 
thold=3.89; 


% GET RID OFF THE FIRST FEW TRANSIENT POINTS 
cpt=10; 


% TARGET TRACKING 


var_we=0.1; 

Vallee == Val ec =o: 

TSk 

phi=[{1 T;0 1]; 

H=flo): 
gam=[(T2)/(2*1000);T/(1000)]; 
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feve(2); 

Q=var_we; 

evar ¢: 
xe(:,1)=[z(1);0]; 
P=diag([var_e var_ed}); 


i=0;j=0; 

for k=1:N-1 
Pp=phi*P*phi+gam*Q*gam'; =% Normal Kalman Filter 
x p=phi*xe(:,k); % only info. we have 


w(k)=H*Pp*H'+R; 

K(:,k)=Pp*H '*inv(w(k)); 
P=(I-K(:,k)*H)*Pp; 

EPO kK )=P(1,1); 

Pe k)=P(1 ,2); 

PP(3,k)=P(2,1); 

Perk )=P(2,2); 
inov(k+1)=z(k+1)-H*xp; 
xe(:,k+1)=xp+K(.,k)*inov(k+1); 


% COMPUTE THE ESTIMATED INPUT 
if k>(cpt+s-1) 

M=0; 

for 1=1:s 
A(Gi, 1)=H*(phi*¥M+I)*gam; 
M=(I-K(:,k-s+1)*H)*(phi*M+D; 
Sinv(i,l)=inv(w(k-s+1)); 

end 

C=A'"*Sinv; 

uest(k)=inv(C*A)*C*inov(k-s+1:k); 


% DETECTION ALGORITHM 


if abs(uest(k))<=thold 
detec(k)=0; 
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else 
detec(k)=3; 
end 
end 
end 


mvprd=find(detec>0); 
strpt=mvprd(1) 


% PLOTTING 


plot(detec), grid,pause 
plot(uest(1:330)), grid 


70 


5. IE SENSITIVE.M 


% File Name : [E_sensitive.m 

Jo 

% Purposes : 

% 1. Apply input estimation algorithm. 

% 2.Compute the input estimates from false maneuver start time 
% using variable length window. 

% 3. Elevation angle only. 

% 4.Run this program for 20 times. 

J 

% By : Meng, Hsing-Han 


cifary IE3_dat315 
for t=1:20 
clear 


% FALSE MANEUVER START TIME 
MPF=315; 


J POINTS OF MEASUREMENT USED TO COMPUTE INPUT ESTIMATES 
s=50; 


% INITIAL CONDITION 

N=600; 
=300; 

amp=3; 
var_we=0.1; 
Var e=2: var _ed=3: 
rand(‘normal'); 
n=1:N; 
w=] *sqrt(var_we)*rand(n); 
v=sqrt(var_e)*rand(n); 
u=[zeros(1,MP-1) amp*ones(1,N-(MP-1))]; 
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% GET RID OFF THE FIRST FEW TRANSIENT POINTS 
cptl=10; 


YJ GENERATE MANEUVERING TARGET 
phi=[1 T;0 1); 
H=[1 0]; 
gam=[(T42)/(2*1000);T/(1000)]; 


x(:,1)=[23;0]; 

z(1)=H*x(:,1)+v(1); 

for k=1:N-1 
x(:,k+1)=phi*x(:,k)+gam*(w(k)+u(k)); 
2(k+1)=H*x(:,k+1)+v(k+1); 

end 


% TARGET TRACKING 
Teale 
xe(:,1)=[z(1);0]; 
levee). 
Q=var_we; 
R=var_e; 
P=diag([var_e var_ed]); 
i=0;;=0;M=0; 


for k=1:N-1 
Pp=phi*P*phi'+gam*Q*gam’; = % Normal Kalman Filter 
xp=phi*xe(:,k); % only info. we have 
w(k)=H*Pp*H'+R; 
K(:,k)=Pp*H'*inv(w(k)); 
ISSUE CIS ED eioe 
PPGaS—EGalb: 
PEC) nu). 
PPGis ECan 


PP(4,k)=P(2,2); 
inov(k+1)=z(k+1)-H*xp; 
xe(:,k+1)=xp+K(:,k)*inov(k+1); 
if k>MPF 
i=i+1; 
A(i,1)=H*(phi*M+I)*gam; 
M=(I-K(:,k)*H)*(phi*M+)); 
SinvG,1)=inv(w(k)); 
C=A'*Sinv; 
uest(k)=inv(C*A)*C*inov(MPF+ 1:k)’; 
end 
end 
umean=mean(uest(399:N-1)) 
end 
diary off 
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6. ELEVESDCR.M 


% File Name : elevesdcr.m 

Jo 

% Purposes : 

% 1. Apply input estimation algorithm 

% 2. Compute the input estimates 

% 3. Perform the detection algonthm 

% 4. Apply the correction algorithm when the absolute value of 
% input estimates less than or equal to the threshold value 
% 5. Elevation angle only. 

Jo 

% By : Meng, Hsing-Han 


clear 

cle,disp(’ ‘); 

fname=input(‘Give the name of target to be processed ? ','s’); 
s=input('How many points of measurement want to use ? '); 
eval({‘load ',fname,'_m’']); 

X=xX_manu; 

Z=z_manu; 


% GIVE THE THRESHOLD VALUE 
th=3.89; 


% GET RID OFF THE FIRST FEW TRANSIENT POINTS 
cpt=10; 


% TARGET TRACKING 


var_we=0.1; 
var_e=2; var_ed=3; 
Tele 

pixie Oe 
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H=[1 0]; 
gam=[(T%2)/(2*1000);T/(1000)]; 
leve(2 ): 

Q=var_we; 

R=var e; 

xe(:, 1 )=[z(1);0]; 

P=diag({var_e var_ed]); 


i=0;j=0; 

for k=1:N-1 
Pp=phi*P*phi'+gam*Q*gam’; % Normal Kalman Filter 
xp=phi*xe(:,k); % only info. we have 


w(k)=H*Pp*H'+R; 
K(:,k)=Pp* H *inv(w(k)); 
P=(I-K(:,k)*H)*Pp; 

et 1 .K)=P(1,1); 

ee 2 k)=P(1,2): 

PP(3,k)=P(2,1); 

PP(4,k)=P(2,2); 

inov(k+1 )=z(k+1)-H*xp; 
xe(:,k+1)=xp+K(:,k)*inov(k+1); 


J COMPUTE THE ESTIMATED INPUT 
if k>(cpt+s-1) 

M=0; 

for i=1l:s 
A(@i,1)=H*(phi*M+I)*gam; 
M=(-K(.,k-s+1)*H)*(phi*M-+]); 
Sinv(i,1)=inv(w(k-s+i)); 

end 

C=A'*Sinv; 

uest(k-s+1 )=inv(C*A)*C*inov(k-s+1 :k)’; 


% DETECTION AND CORRECTION ALGORITHM 


15 


if abs(uest(k-s+1))<=th 
xe(:,k+1)=xe(:,k+1)+M*gam*uest(k-s+1); 
P=P+(M*gam)*inv(C*A)*(M*gam); 
end 
end 
end 
eval([‘save ',fname,' uest xe inov PP K;'}); 


% PLOTTING 


j=1:600; 

plot(uest),grid,title(Estimated Input'),pause 
plotG,x(1,:),j,xe(,:)), grid 

title Real Elevation Angle vs. Estimated Elevation Angle’),pause 
plotG,x(2,:),j,xe(2,:)), grid 

title(Real Elevation Angle Derivate vs. Estimated Elevation Angle 
Derivate’),pause 

plot(PP(1,:)),grid,pause 

plot(PP(2,:)),grid,pause 

plot(PP(3,:)),grid,pause 

plot(PP(4,:)),grid,pause 

plot(K(1,:)),grid,pause 

plot(K(2,:)), grid 
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7, ELEVESDCR_A.M 


% File Name : elevesdcr_a.m 

Jo 

% Purposes : 

% 1. Apply input estimation algorithm 

% 2. Compute the input estimates 

%  3.Perform the detection algonthm 

J 4. Apply the correction algorithm when the absolute value of 
% input estimates greater than the threshold value 
% 5. Elevation angle only. 

Jo 

% By : Meng, Hsing-Han 


clear 

cle,disp( ——'); 

fname=input(‘Give the name of target to be processed ? ',’s’); 
s=input(How many points of measurement want to uSe ? '); 
eval([‘load ',fname,'_m’}); 

X=X_manu; 

Z=Z_Manu; 


% GIVE THE THRESHOLD VALUE 
thold=3.89; 


% GET RID OFF THE FIRST FEW TRANSIENT POINTS 
ept=10; 


% TARGET TRACKING 


var_we=0.1; 
var_e=2; var_ed=3; 
a1: 

phi=[1 T;0 1]; 


ay 


H=[1 0); 
gam=[(T%2)/(2*1000);T/(1000)}: 
I=eye(2); 

Q=var_we; 

R=v.ar /e: 

xe(:,1)=[z(1);0]; 

P=diag([var_e var_ed]); 


=O Se 

for k=1:N-1 
Pp=phi*P*phi'+gam*Q* gam’; % Normal Kalman Filter 
xp=phi*xe(:,k); % only info. we have 


w(k)=H*Pp*H'+R; 
K(:,k)=Pp*H'*inv(w(k)); 
P=(I-K(:,k)*H)*Pp; 
PP(1,k)=P(1,1); 

PP(2,k)=P(1,2); 

PP(3,k)=P(2,1); 

PP(4,k)=P(2,2); 

inov(k+1 )=z(k+1)-H*xp; 
xe(:,k+1)=xp+K(:,k)*inov(k+1); 


% COMPUTE THE ESTIMATED INPUT 
if k>(cpt+s-1) 

M=0; 

for 1=1:s 
AQ, 1)=H*(phi*M+I)*gam; 
M=(I-K(:,k-s+1)*H)*(phi*M-+]); 
Sinv(i,1)=inv(w(k-s+i)); 

end 

C=A'*Sinv; 

uest(k-s+1)=inv(C*A)*C*inov(k-s+1 :k); 


% DETECTION AND CORRECTION ALGORITHM 
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if abs(uest(k-s+1))>=thold 
xe(:,k+1)=xe(:,k+1)+M*gam*uest(k-s+1); 
P=P+(M*gam)*inv(C*A)*(M*gam); 
end 
end 
end 
eval(['save ',fname,'a uest xe inov PP K;’'}); 


% PLOTTING 


lawn N: 

plot(uest),grid,titleEstimated Input'),pause 
plotg,x(1,:),j,xe(1,:)), grid 

title(Real Elevation Angle vs. Estimated Elevation Angle’),pause 
ploy, x(2,:),J,xe(2,:)), grid 

title Real Elevation Angle Derivate vs. Estimated Elevation Angle 
Derivate’'),pause 

plot(PP(1,:)),grid,pause 

plot(PP(2,:)),grid,pause 

plot(PP(3,:)),grid,pause 

plot(PP(4,:)),grid,pause 

plot(K(1,:)),grid,pause 

plot(K(2,:)), grid 


is 


8. ELEVESDCR_D.M 


% File Name : elevesdcr_d.m 

%o 

% Purposes : 

% 1. Apply input estimation algorithm 

% 2. Compute the input estimates using fixed length window 
% 3. Use the computed input estimations to elevesdcr_d1.m 
% 4. Elevation angle only. 

Jo 

% By : Meng, Hsing-Han 


clear 

cle,disp(’ >. 

fname=input(‘Give the name of target to be processed ? ','s’); 
s=input(How many points of measurement want to use ? '); 
eval({'load ',fname,'_m']); 

X=Xelnanue 

Z=Z_manu; 


% GET RID OFF THE FIRST FEW TRANSIENT POINTS 
Chiat: 


% TARGET TRACKING 


var_we=0.1; 
var_e=2; var_ed=3: 
Tel: 
phi=[1 T;0 1]; 
H=[1 0}; 
gam=[(T2)/(2*1000);T/(1000)]; 
[=eve(Z): 
=var_we; 
KR=var ce: 
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Bie eal) —[z( 1 );0]; 
P=diag([var_e var_ed]); 


i=0;j=0; 

for k=1:N-1 
Pp=phi*P*phi'+gam*Q*gam’; % Normal Kalman Filter 
xp=phi*xe(:,k); % only info. we have 


w(k)=H*Pp*H'+R; 
K(:,k)=Pp*H'*inv(w(k)); 
P=(I-K(:,k)*H)*Pp; 

fee! k)=P(1,1); 

ee 2 .K)=F( 1,2); 

Bek =P, 1); 

PP(4,k)=P(2,2); 
inov(k+1)=z(k+1)-H*xp; 
xe(:,k+1)=xp+K(:,k)*inov(k+1 ); 


JY. COMPUTE THE ESTIMATED INPUT 
if k>(cpt+s-1) 
M=0; 
for i=1:s 
A(i, 1)=H*(phi*M+I)*gam; 
M=(I-K(:,k-st+i)*H)*(phi*M+I); 
Sinv(i,1)=inv(w(k-sti)); 
end 
C=A'*Sinv; 
uest(k)=inv(C*A)*C*inov(k-s+1 :k); 
end 
end 


ss=num2str(s); 


eval |Save ,iname,_ ,ss, uest uest; }); 
elevesdcr_dl 
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9. ELEVESDCR_D1.M 


J File Name : elevesdcr_d1.m 

Jo 

% Purposes : 

% 1. Use the computed input estimates to the Kalman filter 
% 2. Elevation angle only. 

Jo 

% By : Meng, Hsing-Han 


clear 

Ele. dispCu an): 

fname=input(‘Give the name of target to be processed ? ','s’); 
s=input(‘How many points of measurement want to use ? '); 
amp=input('Give the magnitude of input : '); 
ss=num2str(s); 

eval([{‘load ',fname,'_',ss,'uest;']); 

eval([‘load ',fname,'_m']); 

X=X_manu; 

Z=Fainane: 

dd=amp/mean(uest(600:999)) 


% TARGET TRACKING 


var_we=0.1; 

Vale = ayAbecU = o: 

oe 

phi=[1 T;0 1]; 

H=[1 0}; 
gam=[(T42)/(2*1000);T/(1000)]; 
lever 

Q=var_we; 

KR=Vabec: 

xe(:,1)=[z(1);0]; 


P=diag({var_e var_ed}); 
i=0;j=0; 


for k=1:N-1 
Pp=phi*P*phi'+gam*Q*gam'; 
xp=phi*xe(:,k)+gam*uest(k); 
w(k)=H*Pp*H'+R; 
K(:,k)=Pp*H *inv(w(k)); 
Pe(l-K(;,k)*H)*Pp; 
fie) k)=P(1,1); 
EP(2,K)=PC1,2): 
PP(3,k)=P(2,1); 
PP(4,k)=P(2,2); 
inov(k+1)=z(k+1)-H*xp; 
xe(:,k+1)=xp+K(-,k)*inov(k+1); 

end 


eval({'save ',fname,ss,d4 uest xe inov PP K;'}); 
Jo PLOTTING 


J=1:N; 

plot(uest),grid,title(Estimated Input’),pause 
plotg,x(1,:),j,xe(1,:)), grid 

title Real Elevation Angle vs. Estimated Elevation Angle'),pause 
plotg,x(2,:),j,xe(2,:)), grid 

titleReal Elevation Angle Derivate vs. Estimated Elevation Angle 
Derivate'),pause 

plot(PP(1,:)),grid,pause 

plot(PP(2,:)),grid,pause 

plot(PP(3,:)),grid,pause 

plot(PP(4,:)),grid,pause 

plot(K(1,:)),grid,pause 

plot(K(2,:)),grid 
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